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© System for controlling artificial knee joint action in an above knee prosthesis. 

© This invention relates to an above knee prothesis which employs a hydraulic damper to passively regulate 
the angular velocity or rotation of the artificial knee joint. A programmed microprocessor recognizes common 
gait patterns from information received from strain and knee angle sensors on the prosthesis^ The microproces- 
sor reacts at various transition points in the gait by activating a motor which in turn adjusts a valve assembly in 
the damper. The valve assembly is capable of variably and separately damping the knee joint motion in each of 
flexion and extension at the same time. Gait is improved because of the improved extent of control of knee 
action. In addition, distinct routines such as stair descending and sitting down can also be practised. 
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FIELD OF THE INVENTION 

This invention provides a system for controlling the rotation of a knee joint of an above knee prosthesis. 
The system employs a microprocessor, responsive to lower leg strain and knee angle measurements 
s originating from sensors on the prosthesis, to control a hydraulic damper through operation of a valve 
assembly associated with the damper, to thereby passively damp or resist the rotation of the artificial knee 
joint. 

BACKGROUND OF THE INVENTION 

w 

As previously stated, the present invention is used with an artificial leg or prosthesis worn by an above 
knee amputee. 

There ars today about 50 different above knee prosthetic devices on the market. Many of these 
prostheses involve: 
is - a socket for receiving and engaging the stump of the user; 

- a knee bracket rigidly connected to the socket; 

- a frame extending down from the bracket and being pivotaiiy connected to the bracket by a horizontal 
shaft, said bracket, shaft and frame together combining to form an artificial knee joint; 

- a pylon and artificial foot connected to the base of the frame; and 

20 - means for controlling the knee joint by locking it to prevent it from buckling under load in the stance 
phase of a step, and freeing it in the swing phase of the step. 
Now, the biological Of natural knee joint is powered by "the- actions- of~muscles: Muscle has two- 
elements. One is the active force developed by contraction and the other is variable stiffness, it has not 
been feasible to duplicate muscle contraction in leg prosthetics, due to limitations arising from weight and 

25 bulk. As a result, research has focused on implementing stiffness into the knee joint. This has usually 
involved switching the knee joint between one of two modes: locked up or free to rotate. 

In recent years, researchers have sought improvement in controlling the action of the artificial knee 
joint, as a way to improve gait and enable the amputee to better deal with certain distinct actions, such as 
descending stairs or lowering into a sitting position. 

30 A relevant patent in this regard is French patent 2623-086-A. This patent teaches providing a strain 
gage sensor on the frame between the knee joint and foot, to measure load. The electronic signals from the 
sensor are transmitted to a microprocessor which monitors the load measurement. When the load signal 
indicates that the swing phase of the step is ending and load is being applied to the leg, the microprocessor 
causes a motor or electromagnet to lock up the knee joint. When the stance phase is complete, the 

35 microprocessor instructs the actuator to release the knee joint, so that it is free to pivot in the swing phase. 
Another relevant prior art reference is Russian patent SU1333-333-A. This patent teaches using a 
sensor at the knee hinge, to measure knee angle. Means lock or free the knee hinge in response to the 
knee angle measurements. 

Another relevant prior art device is known as the Henschke Mauch S-N-S system for controlling an 

ao above knee prosthesis. This system incorporates a linear hydraulic damper for resisting rotation of the knee 
joint at a single damping rate in the stance phase. The damping rate can be varied by manual adjustment. 
When the knee joint is fully extended, the damper assumes a non-resisting mode. Otherwise stated, the 
system lacks automatic variation of damping and incorporates only two states, namely high resistance to 
flexion in stance phase and free rotation in swing phase. 

4$ If a knee joint is looked at as a simple hinge, there are two separate actions which can occur. !n 
"flexion", the knee joint rotates to enable the upper and lower leg segments to move closer together. In 
"extension" the knee joint rotates In the opposite direction, the leg segments move apart and the leg 
straightens. For an artificial knee joint to more closely simulate a biological knee joint, it is necessary that 
control or stiffness be applicable separately and variably in each of the flexion and extension modes. For 

so example, it is desirable at the beginning of the stance {i.e. weight bearing) phase of the step to allow a 
small amount of knee flexion to occur and to then lock the knee against further downward flexion white 
simultaneously freeing the knee to extend as the leg straightens due to body action. So in the latter phase 
of this action, the knee joint is altered to being locked or stiff in flexion and free in extension, at the same 
time. 

55 To applicant's knowledge, there is no artificial knee joint mechanism disclosed in the prior art which 
enables separate, simultaneous and automatic variable control of flexion and extension. 

If such a mechanism could be devised, then a much more sophisticated control over the knee joint 
action could be implemented. 
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It is the object of the present invention to supply such a mechanism and to then incorporate it in an 
improved overall prosthesis. 

SUMMARY OF THE INVENTION 

5 

The present invention relates to an on-board, computer-directed system adapted to provide improved 
automatic control of knee joint rotation in an above knee prosthesis (AKP) having upper and lower lag 
segments joined by the knee joint, said lower leg segment having a foot. In general, the system comprises: 

- a linear, hydraulic damper which can separately and variably damping or resisting each of flexion and 
10 extension rotational movements of the knee joint; 

- electronic sensing means for measuring each of AKP knee angle and lower leg strain (which are 
respectively indicative of the angle between the leg segments and the position of the center of gravity 
of the user's body relative to the AKP foot) and emitting signals indicative thereof; 

- actuating means, such as a servo motor, for adjusting the damping means to vary the resistance to 
15 rotation of the knee joint in at least one of flexion and extension; and 

- programmed computer means for receiving the emitted signals from the sensing means continuously 
establishing from said signals the state of the AKP in the course of a repetitive movement and 
activating the actuating means as required to vary damping to substantially simulate knee action. 
More particularly, the computer means is preferably adapted to do this by comparing the signals to 

so stared threshold values which are indicative of pre-determined transition point between states of the 

AKP in Ihe course of a movement, and, when the received signal values correlate with stored values, 
.... ... then causing the actuating-means to vary, damper-resistance as required so -that the- AKP -kneer-joint- 

actton substantially simulates natural knee action. 
It will be noted that the invention involves separate variation of damping of AKP knee joint action in 
as each of flexion and extension. "Damping" for mis specification means resisting rotational movementrof the* 
knee joint. The resistance may be substantially complete, in which case the knee joint is substantially? 
prevented from rotating in one or both of flexion and extension. The resistance may be partial, in which: 
case the rate of rotation of the knee joint is restricted in one or both of flexion and extension. Or the ; 
resistance may be non-existent, in which case the knee joint is free to rotate in one or both of flexion and: 
30 extension. Alternatively stated, the damper is adapted to control the rate of rotation of the knee joint in one 
or both of flexion and extension. 

To enable such bi-directional damping, applicant has developed a novel damper incorporating a piston 
and means for controlling the piston. More particularly, the variable, linear, hydraulic damper comprises; 

- a hollow closed cylinder filled with hydraulic fluid and having a cylindrical hollow piston adapted to 
35 slide longitudinally within the cylinder chamber; 

- the piston preferably has axial rods extending from its ends, which rods project through seaJed 
openings in the end walls of the cylinder. The piston further carries an exterior circumferential seal 
ring between its ends, for sealing against the side wall of the cylinder; 

- a first aperture and check valve assembly, associated with a first end wall of the piston, enables fluid 
40 to enter the piston chamber from the first end of the cylinder chamber; 

- a second aperture and check valve assembly, associated with the second end wall of the piston, 
allows fluid to enter the piston chamber from the second end of the cylinder chamber; 

- a first pair of diametrically opposed ports extend through the piston side wall adjacent its first end, on 
one side of the seal ring; 

45 - a second pair of diametrically opposed ports extend through the piston side wail adjacent its second 
end, on the other side of the seal ring; 

- preferably, each first port is offset circumferentially from the second port on that side of the piston; 

- preferably, each port is slit-like in configuration; 

- a valve preferably extends into the cylinder and piston chambers and is adapted to progressively 
so reduce or increase the effective area of the first (or flexion) ports available for fluid flow and separately 

progressively reduce or increase the area of the second (or extension) ports; 

- most preferably the valve comprises a rotatable shaft extending into the piston chamber in parallel 
relation to the cylinder axis, said shaft carrying a pair of radially protruding, diametrically opposed 
lobes, each lobe being adapted to substantially seal against the Inside surface of the piston side wall, 

55 each lobe further being adapted, when the shaft is rotated, to progressively cover or uncover the 

adjacent flexion and extension ports, to thereby separately and simultaneously control flow area 
through the flexion and extension ports. 
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In use, one rod of the piston is connected to one segment of the AKP and the far end of the cylinder is 
connected to the other segment. For purposes of this description, It is assumed that the upper push rod of 
the damper piston is pivotally connected to the upper leg segment of the AKP and the lower end of the 
cylinder is pivotatfy connected to the lower leg segment. Therefore, in flexion the damper will contract and 
5 thus the piston will be driven downwardly in the cylinder by body load. In extension, the damper lengthens 
and the piston is pulled upwardly by body action. 

In the operation of the dampen 

- If the valve is positioned to enable flexion and if the piston is forced downwardly, thereby pressurizing 
fluid in the lower end of the cylinder chamber, fluid will flow upwardly through the lower check valve 

10 and extension ports, if open, into the piston chamber and will leave the piston chamber through the 

upper flexion ports - fluid will not leave the piston chamber through the extension ports (if uncovered) 
because there is no significant fluid pressure differential between the lower end of the cylinder 
chamber and the piston chamber; 

- If the valve is positioned to enable extension and if the piston is pulled upwardly, thereby pressuri2ing 
is fluid in the upper end of the cylinder chamber, fluid will flow downwardiy through the upper check 

valve and flexion ports, if open, into the piston chamber and will leave the piston chamber through the 
lower extension ports - again fluid will not leave the piston chamber through the flexion ports because 
there is no significant fluid pressure differential between the upper end of the cylinder chamber and 
the piston chamber. 

20 it will be noted that the damper design is characterized by the following attributes: 

- The valve can be adjusted to vary port areas and thus fluid flow rates to thereby vary resistance to 
knee joint rotation in either flexion or extension at the same time, thereby enabling variation-of 
damping in both directions at the same time; 

- Because the ports are provided in diametrically opposed pairs, the valve does not get pressed against 
25 one side of the piston wall under heavy load and therefore does not seize up or become difficult to 

move - thus a small motor and shaft can be used to control the damper, which contributes to the 
compactness and lightness of the unit; 

- Because the damper is hydraulic, it is not significantly affected by wear and remains substantially 
consistent in its damping performance, thereby enabling the user to become accustomed to its 

30 "action" and to gain confidence in its performance. One could argue that the temperature of the 

hydraulic oil could vary and this would affect consistency of performance but this effect is minimized 
by using aircraft hydraulic fluid. 
In a broad aspect, the damper design therefore involves providing: 

- a pair of closed chambers (for example the two ends of the cylinder chamber; 

35 - means (for example the piston and cylinder) connected to the leg segments and forming two 
passageways (for example each formed by a check valve assembly, the piston chamber and a pair of 
the ports), for moving or pumping fluid from one end chamber to the other through one of the 
passageways when the leg segments are moving together and through the other of the passageways 
when the leg segments are moving apart; and 

40 - means (for example the valve and port assembly) for regulating the flow of fluid through each 
passageway. 

In another aspect of the invention, advantage is taken of the repetitive nature of leg actions. If, for 
example, one is walking along a level surface, there are patterns of knee angle and lower leg strain 
measurements which do not change significantly from step to step. By monitoring the two sets of signals 
45 and timing, the computer software can determine the stage or state of AKP motion and can initiate 
appropriate changes in flexion and extension capability. If there is deviation from the regular pattern, such 
as stubbing the AKP toe in the course of swing phase, the software can detect this change and initiate 
corrective action. 

Thus the system incorporates a method for controlling the knee joint of an AKP, which can be stated in 
50 the case of level walking as follows; 

- storing, in a computer memory, threshold values of lower leg strain and knee angle, which values are 
indicative of the knee bending in stance phase, of anterior positioning of the center of gravity of body 
weight relative to the ankle or foot, and of swing phase, all in the course of a step along a level 
surface; 

55 - continuously sensing lower leg strain and knee angle during use of the AKP and producing electronic 
signals corresponding thereto; 

- comparing the signals against the stored threshold values and, when the signals substantially correlate 
with threshold values, actuating means for altering the rate of rotation of the knee joint in at least one 
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of flexion and extension to enable the knee joint to flex at about the beginning of stance phase, to lock 
the knee joint against flexion while enabling extension in the middle portion of stance phase, and to 
free the knee joint as it approaches the swing phase, thereby substantially simulating natural knee 
action; and 

5 - repeating the foregoing repetitiously. 

By combining the sensing means, the damper having means which can simultaneously and separately 
control flexion and extension and the software based on the profiles of repetitive motion, a knee joint system 
has been evolved which is characterized by closely controlled, predictable responses. This results in the 
user gaining confidence in the system which then manifests itself in the form of a longer and more rhythmic 

io gait. The software can react similarly whether the gait is fast or slow. And the software can be "fine tuned" 
to the particular user to gain further compatibility or altered to modify the operation of the AKP. In addition, 
the system is adaptable to controlling the knee joint in the course of actions other than level walking, such 
as stair descent and sitting. 

From the foregoing, it wilt be understood that the invention utilizes programmed computer means for 

js receiving the emitted signals from the sensing means, continuously establishing from said signals the state 
of the AKP in the course of a movement and activating the actuating means to vary damping to substantially 
simulate natural knee action. More particularly, the programmed computer means is adapted to compare 
the emitted signals against stored threshold values indicative of transition points between states of a 
repetitive movement of the AKP and, when the signals substantially correlate with threshold values, to alter 

20 the rate of rotation of the knee joint in one or both of flex-on and extension. Preferably, the stored threshold 
values are selected from the group consisting of the absolute and derivative values of knee angle and the 
position of the center of gravity of the user's body relative to the AKP foot, the duration from the last 
transition point and the possible future states in the course of the movement 

The invention described can be thought of as a machine which reacts to the amputee's movements, 

25 thus improving gait. Confidence in the machine is necessary for the amputee to take full advantage oft the 
machine's capabilities. This confidence is developed by ensuring that the machine reactions are reproduc- 
ible, step after step. 

In order to obtain consistent and reproducible reactions, the invention takes advantage of the reproduc- 
ible mechanics of the prosthesis during normal walking. As previously stated, during each step the - knee 
so goes through a pattern of movement which is basically the same, step after step. Also reproducible dram 
step to step are the strains on the frame of the AKP, developed by the weight of the amputee, and: the 
angle changes of the knee joint. 

The repetitive nature of the signals is an important aspect of the success of the invention. This allows 
the prosthesis to have consistent man/machine interactions. The prosthesis is a tool used by the amputee to 
35 perform different tasks, if the performance of this tool is predictable and reproducible, then user confidence 
is gained. 

With the reactions occurring at the same time and in the same manner for each step, the amputee 
develops trust in the machine and is able to walk with a continuous fluid motion. 

In summary, the invention works on the principle that each step can be divided into segments or states 
40 and that a machine reaction can be developed for each segment, thus improving gait. The division of the 
step is carried out by first obtaining information from the prosthesis, conditioning this information with 
electronics and analyzing it with software, and then implementing machine reaction by separately and 
simultaneously varying resistance to flexion and extension rotation of the knee joint. 

45 DESCRIPTION OF THE DRAWINGS 

Figure 1 is a block diagram showing the flow of information in the system; 

Figure 2 is a perspective simplified view of the Hall effect sensor used for providing signals indicative of 
knee angle; 

so Figure 3 is a plot of knee angle sensor output versus knee joint rotation; 

Figure 4 is a perspective view of the prosthesis in exploded form; 

Figure 4A is a perspective view of the prosthesis in assembled form; 

Figure 5 is a plot of strain sensor output versus strain or load on the prosthesis; 

Figure 6 is a diagram showing the states in level walking, with the appropriate state conditions shown; 
55 Figure 6a is a diagram showing the states in level walking and correlating them with leg action, piston 

position and valve position; 

Figure 7 is a plot showing the relationship between knee angle and strain (ankle bending moment or 
load) signals, related to the states, for level walking; 
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Figure 7a is a diagram showing the states in stair descent and correlating them with leg action, piston 
position and valve position; 

Figure 8 is a diagram showing the states in sitting down, with the appropriate state conditions shown; 
Figure 8a is a diagram showing the states in sitting down and correlating them with !eg action, piston 
5 position and valve position; 

Figure 9 is a plot showing the relationship between knee angle and strain signals, related to the states, 
for sitting down; 

Figure 1 0 is a diagram showing the states in stair descent, with the appropriate state conditions shown; 
Figure 1 1 is a plot showing the relationship between knee angle and strain signals, related to the states, 
io for stair descent; 

Figure 12 is a comprehensive diagram showing the states and conditions for the various modes of 
action; 

Figure 1 2a is a comprehensive diagram corresponding with Figure 12 and showing the various body 
actions; 

j5 Figures 13 and 14 are simplified sectional side views showing the piston and cylinder in flexion and 
extension modes; 

Figure 15 is a simplified end view of the internals of the piston; 
Figures 16-24 are views similar to Figure 15, showing the vaive in various positions: 
Figure 25 is a side sectional view of the cylinder and piston; 
50 Figure 26 is an overall circuit diagram of the system: 
Figure 27 is a diagram of the communication circuit; 
Figure 28 is a diagram of the microprocessor chip; 

Figure 29 is a diagram of the voltage references and regulator for the analog to digital convenor located 
on the microprocessor chip; 
25 Figure 30 is a diagram of the conditioning electronics for the Hal! effect sensor; 
Figure 31 is a diagram of the conditioning electronics for the strain sensor: 
Figure 32 is a diagram of the conditioning electronics for low battery detection; 

Figure 33 is a flow chart of the software and Figure 34 is an interrupt service routine which is activated 
every 20 milliseconds; and 
so Figure 35 is a perspective view showing strain gauge positioning on the base of the frame. 

DESCRIPTION OF THE PREFERRED EMBODIMENT 

Having reference to Figures 4a and 4b, the prosthesis A comprises a suction socket 1 which is custom 
35 fabricated to closely fit the stump of the amputee and to cling to it by suction. An adjusting plate 2 is 
attached to the base of the socket 1. A knee bracket 3 is secured by screws to the adjusting plate 2. The 
knee bracket 3 has apertured shaft supports 3a, 3b for receiving, supporting and affixing the main knee joint 
shaft 9 and the damper shaft 15 respectively. A frame 4, having a bearing 4a at its upper end, is rotatively 
mounted to the knee bracket 3 by the main shaft 9, which extends through the bearing 4a. The frame 4 is 
40 therefore free to rotate or pivot on the fixed main shaft 9. At its lower end, the frame 4 forms a rectangular 
socket member 4b for receiving a rectangular block 7a which is clamped to the upper end of the foot pylon 
7. Screws secure the pylon block 7a to the frame socket member 4b. A foot 8 is secured to the lower end 
of the pylon 7. 

An upper bearing housing 12 is mounted for rotation on the damper shaft 15. The damper shaft 15 is 
45 located to the rear of the main knee joint shaft 9, so that the shaft 15 and upper bearing housing 12 follow 
an arc relative to the shaft 9 when the knee bracket 3 rotates or pivots. 

A Halt effect sensor 13, shown in Figure 2, is provided to monitor the change in knee angle or knee joint 
rotation. The sensor 13 used is available from Sprague Electronics and is designated as model UGN-3503U. 
This sensor 13 comprises a ring magnet 11, which is fixed to the stationary damper shaft 15 of the knee 
so bracket 3 by a ring magnet keeper 10. The sensor 13 further comprises a Hall effect transducer 13a, which 
is located in the rotatable upper bearing housing 12 and which is positioned facing the ring magnet 11. As 
knee joint rotation occurs, the bearing housing 12 moves around the damper shaft 15, causing the 
transducer 13a to move relative to the ring magnet 11. 

The transducer 13a has a voltage output which is dependent on the magnet flux intensity {north or 
55 south pole) directly before it. Therefore, as the knee joint rotates, the output of transducer 13a changes. The 
signal from the linear Hall effect transducer is amplified to produce .5 volt with a knee joint extended fully 
and 4.5 volts with the knee joint flexed fully. Included in the circuit is a gain adjustment and an offset 
control. Stated otherwise, the signal of the transducer 13a is lowest when the knee is straight and increases 
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as the knee is bent. Figure 3 shows a typical sensor voltage output with respect to knee angle after 
amplification. 

The forces on the foot 8 are established by measuring the strain of the frame 4. This is done using foil 
strain gauges 6 available from Micro Measurements Group Inc., Raleigh, North Carolina under designation 

s CEA - 06 - 062 UW-350. Four gauges 6 are used, two at the front and two at the rear of the frame 4, 
located between the frame apertures 101 and the base of the frame 4, to measure and differentiate between 
load on the heel and load on the toe of the foot 8. Stated otherwise, the strain measurement provides an 
indication as to whether the user body center of gravity is in the anterior, centred or posterior position 
relative to the AKP foot. The four gauges are wired in a wheatsione bridge configuration to produce an 

w electric signal which changes proportionally with strain. The wheatstone bridge configuration is a standard 
arrangement for determining the resistance change of strain gauges. The output of the bridge is amplified 
by a differential instrumentation amplifier 126 to produce an output signal of .5 volts when the heel is loaded 
fully and 4.5 volts when the toe is loaded fully. No load or similar load on the toe and heel produces 2.5 
volts. Included in the circuit is gain adjustment and an offset adjustment. Figure 6 shows a typical voltage 

is output of the bridge with respect to foot loading after the signal is amplified. It will be noted that the load 
signal decreases as the heel is loaded and increases as the toe is loaded. 

A servo motor bracket 14 is secured to the base of the bearing housing 12. A servo motor 16 is 
mounted within the bracket 14. The motor used is available from Airtronics Ltd. under designation 94737. 
An upper spring retainer 17 is mounted on the base of the servo motor bracket 14, for a purpose to be 

20 described. 

A damper B is positioned between the servo motor bracket 14 and the base of the frame 4. 

The damper B comprises a hollow cylinder 26, which is externally threaded. A lower spring mount ring 
27 is threaded onto the outside surface of the cylinder 26, for a purpose explained below. A lower bearing 
mount ring 29 is also adjustably threaded onto the outside surface of the cylinder 26, at its lower end. The 
25 ring 29 has radially extending threaded bores 100, normal to its central axis, which fit lower bearing pins 5 
which are Ihreaded through apertures 101 in the base of the frame 4. Thus the base of the cytinder-26 is s;-; 
pivotatty coupled to the base of the frame 4 by threading the pins 5 into the bores 100 of the ring 29. Attack v 
ring 28, threaded onto the external surface of the cylinder 26, is tightened against the ring 29 to locknt in a 
place. 

30 A lower cap 30 fits into the bore 102 of the cylinder 26 at its lower end and closes the bore. The lower 
cap 30 is held in place by a snap ring 103. The lower cap 30 carries a circumferential O-ring 104, for 
sealing against the side wall 105 of the cylinder 26. An aperture 106 is formed through the cap 30. Ah O- £ 
ring 107 is mounted in this aperture 106, sealing around the dummy push rod 25 of a piston 24. . 

At its upper end, the cylinder 26 has an upper cap 21 which fits into the cylinder bore 102 and is held 

35 in place by a snap ring 108. The upper cap 21 aiso carries a circumferential O-ring 109, for sealing against 
the side wall 105 of the cylinder 26. An aperture 110 is formed through the cap 21. An O-ring 111 is 
mounted in this aperture 110, for sealing around the push rod 22 of the piston 24. 

The hollow cylindrical piston 24 is positioned in the cylinder bore 102. The piston 24 comprises an 
open-ended drum 112 having upper and lower end caps 113, 114 screwed thereinto. A push rod 22 extends 

40 upwardly from the upper end cap 113, through the sealed aperture 110 in the cylinder cap 21, and is 
secured to the servo motor housing 14. From the foregoing, it will be noted that the bearing housing 12, 
servo motor housing 14 and push rod 22 form a train of components connected to the damper shaft 15 and 
bracket plate 3. Thus as the socket 1 pivots about the main shaft 9, this rotational movement is converted 
into linear movement of the push rod 22 and piston 24. 

45 A tubular spring 18 extends concentrically around the cylinder 26 between the upper spring retainer 17 
and lower spring mount ring 27, for assisting the assembly to increase rate of knee extension during the 
swing phase of gait. This is useful in enabling increased speed of gait. 

The piston 24 and cylinder 26 are shown in simplified form in Figures 13 and 14, with the fluid flows 
identified by arrows in each of flexion and extension. 

so The cylinder 26 is a closed or sealed unit and it is filled with hydraulic fluid. The piston 24 carries an 
external circumferential ring seal 1 15 for sealing against the side wall 105 of the cylinder 26. 

The upper cap 1 13 of the piston 24 has an aperture 116 opening into the piston chamber 1 17. A spring- 
loaded one way check valve 118 controls the aperture 116 and allows pressurized hydraulic fluid to move 
downwardly from the upper end of the cylinder chamber 119 into the piston chamber 1 17. 

ss The lower cap 114 of the piston 24 has an aperture 120 opening into the piston chamber 1 17. A spring- 
loaded one way check valve 121 controls the aperture 120 and allows pressurized fluid to move upwardly 
from the lower end of the cylinder chamber 119 into the piston chamber 1 17. 
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The check valves used are available from the Lee Company, Westbrook, Connecticut, under designa- 
tion CKFA 2506205A. 

A first pair of diametrically opposed flexion ports 122 extend through the piston side wall 123 at a point 
above the piston circumferential seal 115. A second pair of diametrically opposed extension ports 124 
5 extend through the piston side wall 123 at a point below the circumferential seal 115. 

From the foregoing and having reference to Rgure 13, when body weight acts downwardly on the push 
rod 22 and piston 24, with the flexion ports 122 open, hydraulic fluid may flow upwardly from the lower end 
of the cylinder chamber 119, through the lower check valve 121 into the piston chamber 117, out of the 
piston chamber through the flexion ports 122 and into the upper end of the cylinder chamber 119. 
10 Therefore, as long as the flexion ports 122 are open, the piston 24 may move downwardly, the damper B 
may contract and flexion of the knee joint may occur, if the flexion ports 122 are only partly open, there is 
damping or resistance to the knee rotation in flexion. If the flexion ports 122 are closed, the piston 24 is 
prevented from moving downwardly and the knee joint is locked against flexion. 

Similarly, having reference to Figure 14, when the push rod 22 and piston 24 are pulled upwardly, with 
75 the extension ports 124 open, pressurized hydraulic fluid may flow downwardly from the upper end of the 
cylinder chamber 119, through the upper check valve 118 into the piston chamber 117, out of the piston 
chamber through the extension ports 124 and into the lower end of the cylinder chamber 119. Therefore, as 
long as the extension ports 124 are open, the piston 24 may move upwardly, the damper B may extend and 
extension of the knee joint may occur. If the extension ports 124 are only partly open, there is damping or 
20 resistance to knee extension. If the ports 124 are closed, the piston 24 is prevented from moving upwardly 
and the knee joint is substantially locked against extension. 

As previously stated, restriction of the fluid flow through the ports reduces the flow of fluid through the 
hollow piston, thereby controlling the rate of movement of the piston. 

The rate of flow of the fluid is controlled by an adjustable rotatable valve 23. This valve 23 is illustrated 
25 in Figures 4, 4b and 16-24. It comprises a shaft or rod 36 carrying a pair of lobes 125. The rod 36 extends 
axially and centrally into the piston chamber 117. It further extends upwardly through a bore 126 in the push 
rod 22 and is drivably connected with the servo motor 16 housed in the bracket 14. 

The lobes 125 extend radially from the rod 36, substantially seal against the inside surface of the piston 
side wall 123 and each is adapted to extend vertically across both the upper flexion port 122 and the lower 
30 extension port 124 on one side of the piston 24. 

The associated ports 122, 124 on each side of the piston 24 are circumferential I y offset, as shown in 
Figures 16-24. Stated otherwise, the lower extension port 124 begins approximately where the upper 
flexion port 122 ends. The ports 122, 124 are narrow elongate horizontal slits. Typically they might have a 
length of .25 inches and width of .02 inches. 
35 Therefore, there is a progressive nature to the reduction and subsequent increase in open area of a port 
as the valve lobe moves across it on a rotational travel. This of course affects the rate of fluid flow through 
the piston chamber 117 and determines the relative damping or resistance to rotation experienced by the 
knee joint. 

By ctrcumferentially offsetting the associated pair of upper and lower ports, there is a sequential and 
40 separate nature to the opening and closing of flexion and extension ports. 

Stated otherwise, and as shown in Figures 16-24, the flexion and extension ports of an associated pair 
of ports on one side of the piston: 

- can each be separately progressively opened or closed; or 

- each can be separately fully opened or closed; or 

45 - one can be fully closed while the other is progressively closed; or 

- both can be fully closed, 

and all of the foregoing can be accomplished with a single motor and valve, thereby assisting in achieving 
compactness and low weight. 

The rotation of the inner valve 23 is determined by the software controlling a microprocessor 32, which 

50 in turn controls the servo motor 16. 

Each step or movement of the prosthesis has been divided into segments (states), dependent on 
comparison of the incoming sensor signals and preset threshold values. Held in the memory of the 
microprocessor is a position signal for the inner valve 23. With each change from state to state the inner 
valve 23 position is altered, thus achieving a different knee joint control. For example, referring to Figure 6A, 

55 state No. 1, the initial portion of stance phase, the inner valve 23 is set to allow fluid to escape from the 
flexion ports 122 and consequently the knee joint can bend as the amputee applies weight. The 
programmed computer monitors the increasing knee angle and when it reaches the stored threshold value 
that indicates that the knee has bent to the predetermined angle initiating state No. 2, then the position of 
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the inner valve 23 is altered to completely restrict fluid flow from the flexion ports 122 and allow flow from 
the extension ports 124. This stops further knee joint bending and allows extension. 

The above example illustrates that the assemply can have different control parameters depending on 
the direction of knee joint rotation (i.e. locked in flexion and allow extension). The fluid passes through 
s separate ports for each of the two directions of knee movement. Therefore, if the flexion and extension ports 
are restricted independently of each other, the control of the rate of piston movement can be different for 
each direction. 

The Figures 16-24 show discrete positions for the inner valve 23. In fact the positioning of the inner 
valve can be set at any position from 0 to 100 degrees, thus obtaining virtually an infinite range of knee joint 
10 damping. This is desirable for "tuning" the leg in activities such as stair descending, where the rate of 
descent must appeal to the amputee. 

The microprocessor 32 used is available from Motorola Semiconductors Ltd. under designation XC 68 
HC 81 1 £2 FN. This is an 8 bit processor having 2K of memory, 8 analog to digital converters, and 8 digital 
inputs. The chip is about 1 " x 1" and there is no need for any other peripheral chips, thereby allowing it to 
is fit into a small package within the prosthesis A. 

The knee angle and load sensor signals are amplified and then fed directly into the microprocessor 32. 
The amplifiers 126, 127 used for knee angle and load signal conditioning are available from Texas 
Instruments under designations TLC 272 and TLC 274 respectively. 

As shown, the amplifiers 1 26, 1 27 and microprocessor 32 are mounted on a circuit board 20 and are 
20 enclosed together with a battery 34 (Motorola SNN 4038A) and battery holder 33 in a shell 19 which is 
secured to the frame 4. 

SOFTWARE 

25 The software is set forth in the flow chart and attached Appendix. r-r 

Due to the similarities of the sensor information during the course of each step from one step to another 
(repetitiveness) it is possible to determine the amplitude of each of the two signals at transition points 
during each step. These transition points are important times when the damping of the knee joint should be 
altered to allow the amputee to walk. The transition points are detected by the processor 32 by comparing 

so the predetermined "threshold" values, stored in memory, with the real signals from the prosthesis A and 
cycling through the transition points as they occur. As long as the amputee continues to produce signals as 
expected, the processor can keep track of the cycle. 

With this type of software in operation the hydraulic damper B can be adjusted as each transition point 
occurs, to a new position which was predetermined during fitting, 

35 This system can therefore determine the position of the prosthesis A during the course of each step 
and apply an appropriate damping coefficient to the knee joint. Furthermore it is possible to detect whether 
the amputee is walking on level ground, down stairs, sitting down or has encountered a dangerous situation 
such as the toe of the prosthesis hitting the ground during swing phase (to© stubbing). 

40 Level Ground 

Figure 6A illustrates the point. Each of the numbered circles are referred to as states. The processor 
always begins in state #1 where the step begins. As the amputee applies weight to the prosthesis A the 
knee joint begins to bend. This increases the knee angle signal which is continuously being compared to a 
45 preset threshold value and as it equals or exceeds the threshold value the processor cycles to state #2. The 
hydraulic damper setting is altered at the transition point to predetermined settings to allow knee flexion 
while in state #1 and to lock knee flexion while in state #2. 

During state #1 the damper's function is to damp knee flexion and simultaneously allow knee extension 
and during state #2 to lock knee flexion and simultaneously allow but damp knee extension. Note that the 
so flexion damping has gone from a damped setting to a locked setting independent of the damped knee 
extension setting. This design allows the amputee to straighten the knee during state #2 even though the 
knee flexion Is still locked. 

The damped setting is required to control the rate of knee extension as the amputee proceeds. If a free 
extension setting was chosen the knee would "snap" straight giving the amputee a noticeably abnormal 
as gait. 

The initial knee flexion after heel contact and the straightening of the knee is found in normal gait 
patterns and is referred to as "knee bounce". 



9 
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The exact mechanics as to how the hydraulic clamper functions is shown in Figure 6A beside each 
numbered circle. 

Figures 6 and 7 show the rules used for the comparison and the actual values of the output of the 
sensors expected for one step. Following through the step it can be seen that the transition from state #1 to 
5 state #2 occurs as the knee angle signal in Figure 7 increases. 

The graph shows that knee flexion stops shortly after the transition to state #2. The time delay is the 
time required for the damper to change. 

As the amputee proceeds through the step the next important event is swing phase (time while the foot 
8 is off the ground). Indication of the oncoming swing phase can be detected by continuously monitoring 
io the load signal and comparing it to a predetermined value. 

As the centre of gravity of the amputee pass over the foot, weight is applied to the toe. The increase in 
the load signal causes the processor to switch to state #3 as soon as the load signal is equal to or exceeds 
the predetermined threshold value. The damper is commanded to unlock the knee joint, thus allowing the 
amputee to initiate swing phase when ready. 
is The entire swing phase is tracked by the processor. The transition to state #4 occurs when the knee 
signal increases past a preset threshold value as the knee joint flexes during the initial portion of swing 
phase. 

After state #4 the strain or load signal is ignored and the processor monitors the first derivative of knee 
angle. The derivative is an indication of the speed and direction of the knee rotation. As the knee joint 
20 reaches the maximum flexion during swing the derivative becomes zero and detection of this produces a 
switch to state #5. Note that the same command for the damper is maintained throughout states #3-4-5, that 

is, free flexion and free extension which allows swing phase to be completed. . 

Completion of the swing phase is detected when the knee angle signal decreases past a preset 
threshold value to indicate that the knee joint has extended back to the straight position. The processor 
26 switches to state #1 and the entire process is repeated as long as the amputee continues to walk on level 
ground. 

Emergency Swing Phase Recovery (Stubbing the Toe) 

30 The normal repetitive pattern of knee angle and strain information causes the processor to cycle 
through state #'s 1-2-3-4-5-1 {see Figures 6 & 7). When the toe of the prosthesis has contacted an obstacle 
during the swing phase the pattern is different. The pattern is now 1-2-3-4-5-6-1. After state #5 the 
processor monitors the knee angle derivative information and switches to state #6 if the first derivative has 
become positive, indicating that the knee is no longer extending but is now flexing (i.e. the obstacle has 

as interrupted the normal velocity of the knee extension). During state #6 the damper is instructed to lock the 
flexion of the knee joint. 

Additional state changes exist for the level walking diagram. Circumduction is the completion of the 
swing phase without flexing the knee joint. This is done by swinging the limb sideways in an arc to clear the 
ground instead of flexing the knee. Without the flexion of the knee during file swing phase the processor 
40 would switch from state #'s 1-2-3 and stop. This problem is alleviated by measuring the time that the 
processor is in state #3 and if the knee has not been flexed in a predetermined amount of time the 
processor switches back to state #1 regardless of any inputs. 

Sit Down Mode 

45 

During the daily events there are times when the amputee is sitting for an extended period of time. The 
knee joint of the prosthesis should be in an unlocked position for this time in order for the amputee to 
position the leg in any desired position. For instance he may wish to have it flexed to place the foot under a 
chair, or in a right angle position to sit upright, or in a partially flexed position for sitting in a car. The 
so positioning is done by manipulating the prosthesis usually with the hands or the contralateral (other) foot. 

Sitting is accomplished by training the amputee to perform a certain move to instruct the processor of 
the attempt to sit down. Figures 8A and 8 show the cycle of states for sitting down. Figure 9 shows the 
change in signals for a typical sit down motion. Initially the processor will be residing in state #1. The 
amputee leans backward which increases the load on the heel of the prosthesis and begins to flex the knee 
ss joint. The processor switches from state #1 to state #2 as the knee signal passes a preset threshold value 
(see state change on Figure 9). 

The load on the heel decreases the load signal past a preset threshold value and the processor 
switches to state #7. As soon as the processor switches to state #7, a timer starts and measures the time 

in 
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which the toad is present on the heel. After 1/3 of a second the processor switches to state #8 which 
commands the damper to allow knee joint flexion. The amputee bears weight on the prosthesis and 
descends to the chair at a controlled rate. Measurement of time is again made and the processor switches 
to state #9 after 3/4 seconds. This commands the damper to be free in both flexion and extension of the 
5 knee joint, allowing the amputee to manipulate the leg to be comfortable in the seated position. The 
processor will remain in state #9 until the knee joint is extended to the straight position thus decreasing the 
knee angle signal past a threshold value at which the processor switches to state #1. 

Stair Descending 

10 

The usual method for an amputee to descend stairs is to use only his good leg to lower his body weight 
down each stair until his prosthesis contacts the next stair. Ha then repeats the motion again using the good 
leg. The prosthesis is not used at all and the descent is "one stair at a time". 

The second method is for the more agile amputee and consists of the normal "step over step" 
75 approach but doing so with the knee having uncontrolled descent as his weight flexes the knee {jack 
knifing). 

The present invention incorporates a method of first detecting the fact that the amputee is about to 
descend a step and then offering a controlled rate of descent. 

In order to initiate the descending of stairs, the processor must receive the appropriate signals from the 
20 user. This is done by placing the heel of the prosthesis on the edge of the stair and applying weight. Similar 
to level walking the first state change is from state #1 to state #2 as the knee begins to flex (see above). At 
this point the load signal decreases (heel loading) and the processor switches to state. #7 and then to state 
#10 as flie load reaches a preset threshold value (see Figures 10 & 11). 

Note that the amount of weight placed on the heel by the user determines whether the processor stops 
25 at state #7 (detects "sit-down") or continues to state #10 (detects "stairs"). The user is trained to apply/ the 
appropriate weight to instruct the processor correctly. 

A timer is started when the processor switches to state #10. As long as the user maintains the load for 
1/2 second the processor will then switch to state #11. During state #11 the damper is commanded to damp 
the flexion of the knee joint and allow extension. This damping is similar to the hydraulic control unit on a 
30 door. The rate at which the door can swing is controlled by the hydraulic fluid within the cylinder. For the 
knee this damping is preset dependent on the wishes of the user. Some like to descend stairs at a slow: rate 
while others prefer a fast descent. 

At completion of each stair the user descends the next step on his contralateral (other) limb. During this 
time the processor is waiting for the knee joint to extend during the swing phase. The extension reduces the 
35 knee signal past a preset threshold value and the processor switches to state #12. The damper is 
commanded to lock flexion and allow extension. The user again places the heel on the next stair and 
repeats the sequence 7-10-11-12 for each step. Note that the processor does not return to state #1 after 
each step. This is due to the lack of a complete extension of the leg prior to the next step. 

Once the flight of stairs has been completed, the knee joint is extended to the straight position and the 
40 processor switches to state #1 as the knee angle is reduced to a preset threshold value. The choice 
between stairs, sit down or level walking is now available. 

Figure 12 shows all of the states grouped together. At the beginning of each step the software detects 
whether the amputee is proceeding on level ground (state #'s 1-2-3-4-5-1), has stubbed the toe during a 
step on level ground (1-2-3-4-5-6-1), is sitting down (1-2-7-8-9-1) or is descending stairs (1-2-7-10-11-12). 
45 The amputee need not push any buttons or turn any levers to instruct the processor to change functions 
for different terrains. Detection is automatically done in real time dependent on the movements of the 
amputee. 

Additional features of the state diagram include a battery life saver. If the amputee stops for more than 
3 seconds in states i, 2 or 9 the processor stops powering the control motor and goes to a shutdown state, 
so A low battery warning beeper signals the user that battery replacement is required. In the event that the 
battery is completely depleted the damper is commanded to damp flexion and free extension prior to 
complete loss of power. This allows the amputee to still bear weight on the leg without excessive knee 
flexion until a charged battery is placed in leg. As the flexion is damped the swing phase must be 
accomplished by circumduction during this time. 

55 
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APPENDIX 

;**•* ** toxt formats ••••*••»••• 

;ALLCAPS: main antry point or CONSTANTS 
:iow«r: iocal labels 
;Mixed Ham variabfo* 
;name. subr 

;NAM£| main commands dispatched 



1? 
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: generally a blank line follow* changes in (low. or logical thought, 
; or before entry points. 



;Exiernel addresses in currant knao contiolior 5/88 
;Using EVM board defaults to simplify debugging 
;MC8 has RAM 0-7fff. ROM 8000-ffff. OACs fffO-ffff 



53 






RAM $0000 • SOOFF 2S6 bytes Or 51 2 in E9 chip 








REGS S1OO0-S10FF $8000 in MC8 IF needed 


55 






EEPROM $8SOO - S87FF 512 bytes 


56 






EPROM $FCO0 - 9FFFF 4k 2732 external 


57 






EPROM $0000 - SFFFF 1 2k in 68HC71 1E9 


sa 






EEPROM $F800- SFFFF 2k in -A2/E2 epus 


59 






OACS SFFFO - SFFFF only 8 active, eddr wrap*. 


60 
















62 


oooo 


as 


equ $0000 ;Ram stone hare 






TOS 


equ RS * $FF ;Top Of Stack (or - A1 (256 bytes! 


64 


1000 


REG 


oqu $1000 .'Registers sit here 


65 
66 




;9/02/9Q.tq use EVM for development 


67 




;csn't load EVM EEPROM @ SB600 directly with S records so we're stuck hero 


68 


0001 


CHIPA2 


equ 1 ;if using -A2/E2 for code 


69 
70 


101 s 




ifnde(CHIPA2 ;if not -A2/E2 • 


71 




EE 


equ $8600 ; EEPROM starts here in -A1/E3 version 


72' 




EES" - 


aqu S FSOO -;ttulas sTdreaKere forlst tiff* up.' ~ " " 


73 




;Bootup 


eopiee to EE if difference in 1st 2bytoa detected Idetel. 


74 




ROM 


aqu SF9O0 r 2732 starts @ $0FOO0, 2764 © $06000 -A2 <S> F800 


7S 


(01! 




else ;in a 2k EEPROM device we have... 


76 
77 


FSOO 


EE 


equ SF800 ;EEPROM starts here in -A2 version in Single Chip mods 


78 


F900 


ROM 


equ 4F900 ;start code here in single chip mode 


79 








80 




;EE 


aqu SE800 .EEPROM set here in -A2 version in Expanded mode. 


81 




;R0M 


equ $E900 ;atarc code here in Expended mode 


82 








83 


F800 


EES 


equ EE ,-botfv in same place in -A2's 


84 


I00| 




endif ■ 


85 








86 






cpu darns. Uses REG value defined above or defaults to $1000 IFNDEF 








INCLUDE d:\e68n\ruie\osm\6ai1reg.aem 


38 


0000 




INCLUDE \A6S11\6B11 REG.ASM 


39 






.NUSTO 


30 




;01/28/9l 


91 


ton 




ifndef REG rdefatilt if not defined elsewhere 


92 




.... REG 


equ $1000 


93 


|00[ 




■ endif . ' 


94 




CPU I/O PORTS 


95 


1000 


PORTA 


equ REG + $00 ; Port A & Timer Funcs 


96 


1002 


P10C 


equ REG + $02 ;port dir/stbs control 


97 


1003 


PORTC 


equ REG + $03 J»ort C I/O 


98 


1004 


PORTB 


aqu REG + $04 ;Port 9 Out 


99 


1005 


PORTCL equ REG + $05 ;Port C Latched in 


100 


1007 


DDRC 


equ REG + $07 ;Data OiR port C 


101 


100S 


PORTD 


equ REG + $08 ;Port 0 
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iooe 

1010 
1012 
1014 
1016 
1019 
101A 
101C 

love 

1020 
1021 
1022 
1023 
1024 
102S 
1026 
1027 

1028 
T023 
102A 



TIMER 
CFORC 
OC1M 
OCIO 
TCNT 
T1C1 
T1C2 
TiC3 
T0C1 
TOC2 
TOC3 
T0C4 
TOCS 
TCTLI 
TCTL2 
TMSK1 
TFLG1 
TMSK2 
TFLG2 
PACTL 
PACNT aqu 



COMPARE 
REG * SOS 
REG + 40C 
REG + $00 
REG + SOE 
REG + 310 
REG + 412 
REG + J14 
REG + 9 1 fl 
REG + $18 
REG + * 1 A 
REG + »1C 
REG + *1E 



REG -c* 23 
REG + *24 
REG + J25 
REG + S26 
REG + 427 



REGS 

;Compare force rag 

;OC1 action Mask 

;0C1 Oata 

iTimar Counter rag 

;lnptrt Capture 1 

;IC2 

;IC3 

; Output Compare 1 

:0C2 

;0C3 

:0C4 

;OC5 

.•Timer Control Reg 1 
;TC reg 2 

.-Timer MaSK interrupt reg 1 
.-Timer FiaG int reg 1 
,'Timer MaSK int reg 2 
; Timer FLeG int rag 2 
;Pul«e Acc ConTrol. rag 
;PA CouNT 



..... spl P0RT 
SPCR equREG + *28 
"SPSR equHEGT-f 329 
SPDR ««.u REG + »2A 



103S 
1039 
103 A 
103B 
103C 
1030 
I03f 



0000 
0002 
0003 



SCCR1 «quREG + 42C 

SCCR2 sou REG + $20 

SCSR aquREG + *2£ 

SCOR equ REG + J2F 

..... Ay0 R£GS .... 

AOCTL equ REG + 430 

A0R1 equR£G + *31 

AOR2 oquREG + *32 

A0R3 equfl£G + *33 

A0R4 aqu REG + 434 



• CPU CONTROL REGISTERS 



;SCI control register 1 

;SCi register 2 

,-fiCI statu* regiatar 

;sariai communicacona data register 



8PROT 

OPTION equREG + 439 

COPRST equ REG + 43A 

PPROG equ REG + 43B 

HPRIO *quREG + S3C 

INlT equ REG + 430 

CONRG equ REG + 43F 



;Block protect in -E8 flavour 



;C0P ai 
;EEPR0M Control 

highest priority 1-bit interrupt end mite. 
;Roro 4i t/0 mapping 

iCop/Rom/EEprom enable* & EE adr in -A; 



_PORTA equ »00 ;Port A & Timer Func* 
_PIOC equ $02 ;port dir/stba control 
_PORTC equ »03 ;Port C I/O 



SO 
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0O04 
0005 



PORTB aqu *04 ;Port 0 Out 
0005 _PORTCL aqu $05 ;PortC Latched in 

0007 _ODRC aqu $07 ;Data DiR port C 

0008 _PORTD aqu SOS ;Port 0 
™ na lODRD aqu *09 .Data DiR port D 

_PORTE aqu 40A ;Port E fof digital in on A/0 



0009 
OOOA 

* * * TIMER / COMPARE REGS 

0008 _CFORC aqu $08 ;Comparo forca rag 

OOOC ZoCIM aqu *0C ;0C1 action Mask 

0000 ~0C1D aqu $00 ;0C1 Data 

O00£ _TCNT aqu $0£ ;Thr»r Counter rag 

0010 jnC 1 aqu 910 ;lnput Capture 1 

0012 _TIC2 aqu * 12 ;IC2 

0014 JtC3 aqu $14 ;IC3 

0016 _T0C1 aqu i16 ;Output Compara 1 
0018 T0C2 aqu $18 ;0C2 

001 A JT0C3 equ$lA;0C3 
001 C T0C4 aqu *1C ;0C4 

001 E T TOCS equ$l£ ;OCS 

0020 TCTL1 aqu 420 ;Timer Control Rag 1 

0021 _TCTU2 aqu $21 ;TC rag 2 

0022 TMSK1 aqu $22 ;Timer MaSK interrupt rag 

0023 _TRG1 aqu $23 .-Timer FLaG int rag 1 

' ■ :0024- - -.^TMSrU-aqu' $24 ^mar^MaSK int rag Z - 

0025 _TFLG2 aqu $25 ;Timer FUG int rag 2 

0026 PACTL aqu $26 ;Pul«* Ace ConTroL rag 

0027 J>ACNT aqu $27 ;PA CouNT 

;""SPIPORT 

0028 SPCR aqu $28 ;SPi control rag 

0029 _SPSR aqu $29 ;SPi atatut 
002A _SPDR aqu $2A ,-SP) data 



..... SERIAL COMMUNICATION iNTERFACE REGS 

002B _BAUD aqu $2B ."baud rate regiiter 

0O2C "SCCR1 aqu $2C ;SCI control register V 

002D _SCCR2 aqu $20 ;SC1 register 2 

0026 _SCSR aqu *2E ;SCl statu* register 

002F _SCDR «qu *2F ;sarial communications data regiatar 

;•••* A/0 REGS •*". 

0030 _ADCTl. aqu $30 ;A to 0 control register 

0031 A0R1 aqu $31 ;A/0 results 

0032 ADR2 aqu $32 

0033 _A0R3 aqu $33 

0034 _ADR4 aqu « 34 

CPU CONTSOt REGISTERS 

0035 _8PR0T aqu »3S ;aock protect in -E8 flavour 

0039 .OPTION aqu $39 ; system configuration options 

003A ^COPRST aqu $3A ;C0P arm/raeat 

0038 _PPROG aqu $3B ;EEFflOM Control 

003C HPRIO aqu $3C ;higha«t priority t-bit intemipt and miac. 

0030 INiT aqu $30 ;R«m & I/O mapping 

0O3F _C0NRG aqu $3F ;Cop/Rom/EEprom enabJe* & EE adr in -A2 
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"Some standard c< 



217 


OOOQ 




equ $00 


Null termination for string* 


218 


0001 


EOT 


«qu 401 


End of Text 


219 


000A 


LF 


«qu SOA 


LF 


220 


OOOD 


CR 


equ $00 


CR 






XON 


equ $1 1 


*Q 


222 


0013 


XOFF 


equ $13 


*S 


223 


001A 


EOF 


oqu $1A 


"Z 


224 


0018 


ESC 


equ $1B 


Esc code 


225 


0018 


CAN 


equ $18 


*x 


226 


0020 


SPC 


equ $20 


space coda 


227 








228 






.UST 




229 


0000 




END 


of definitions 



23* 
23S 
236 
237 
238 
239 
240 



244 
245 
246 
247 



2S2 
2S3 
2S4 
2S5 
256 
257 
258 
259 
260 



264 
265 
266 

2S7 
268 



0004 
101 i 



[01] 
0030 
9C40 
0014 
1001 



002A 
003E 
003C 



SDRATE equ $4 

ifdef MH27 
; • * * * Servo specific vi 
BRATE equ $12 
RTCRAT equ 36864 
MOEG equ 22 

else 

BRATE eqg $30 
RTCRAT equ 40000 
MOEG equ 20 



;debug step rata 
;if 7.372SMta ... 

; $12-9600 $??-300 6>7.372flMhz /3M 
;real time dock »20mSae for 7.3728Mhx xtoJ 
;Approx scale tic to time for 7.3728 

.•define default com r«te $30-96008 S34-6O0B @3Mhi 
;reai "time clock 20mSec 
;Approx scaJe tic to time 



; • * • • Terminal I/O Coda* 

PROMPT equ *•' 

GRS equ'>' 

LTS equ '<' 

EOS equ 

EOL. equ CR 



; EEROM us* in 
,0000 OOOF Dot 
.•0010 01FF Rul< 



tingle chip moda -A2 

, Bdrata... CHNTBL 

taW« (up to coda lower Umit), 



• RAM ui 



.00 - OF Copy of EC being adjusted. Must Suva to make change* p 
;10 - IE Sroadr, Curmbf, Currul, Scnrul, Outadr, Frcrul, Ffctim, 
;20 - EMPTY 

;3E 8«epar timer (don't mova, dup defn in rules for separata assembly). 

;40 - 4F Main flags 4 rem variables 

;50 - 6f Arteiog HFO 24 bytes + derivatives (8» 

;70 - 7F Ttmar OCx reloads & phases (yet to implement) 

;80 - 8F 1/0 buffaie * vara ;1NBUF_STA used by pb«« for EES AVE ram routirw 
;C0 - FF stack space <E0 + mini) I 'Each int uses 9 bytes of atackl ! 



270 

271 0000 



* Rule work space ***•• 

org RS ,'workapece for uming/adjust 
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272 0010 

273 0000 
274 

27S 

276 0010 

277 0010 

278 0012 

279 0012 

280 0018 

281 001 S 

282 0018 

283 0019 

284 001 A 
285 

286 001 C 

287 0010 
288 

289 001 e 

290 001 F 

291 0020 



29S 0023 
296 

297 0025 



Wrkrul dsRSlZ 



ithis many to store in Eg at a lima 

;space For copy of whatever we're adjusting 



org RS + S 1 0 ;start of ram tables 
Sccadr ds 2 .-source address of rule t (or data) in ram 

curmbf ecju * ;fix assembler stupidity (DO NOT MOVE Curmbf. SRULxx fixed raf 

Curmbf da 4 rwhere active mode bit fields stored <32 MAX rules for now! 
stime equ 3 ;stupid assembler 

Stima DS 2 shutdown tjmer (batterY) 00 NOT MOVE Soma. BRULxx fixed raf) 

Curmod OS 1 icurrentiy active mod*. Currui MUST follow 

Currui DS 1 currently active rule. 

Outadr OS 2 .address of motor value for fired rule (gtime) 

Frcrul ds 1 .-Forced rule, MUST preceed Frctim 

Frctim ds 1 ;Rule timer, MUST follow Frcrul. (SEARCH) 8t inits STD X 

Inhrul da 1 ;Rule to inhibit for time specified. Inhom MUST FOLLOW 
Irthtim ds 1 ;lntwbit a rule timer, tnhrui MUST PRECEED 
Scnrul DS 1 ; scan ml counter (SEARCH) MUST fo!(ow Inhtim 

;0C1 period. Basic sample rata (not vat uaed) 

;B«eper_iimar^egister 



Ocltima DS 2 
Rtjme_ DS 2 
Offadr DS 2 
;R«g d» 2 



;addrosa offset for print outa 

;REG address for fewer bytoa of LDX #R£G (9 rafa) not used yet 



300 
301 

302 003D 

303 1008 

304 0020 

305 0030 
308 003F 
307 

308 0040 

309 0080 

310 0040 



Main vara in RAM ••**• 
orgRS + »3D 
SPORT equ PORTD : ;beeper port 
SetT oqu 820 ;bit in PORTD co ntrollirtg beeper (DS - *SS) 
Btima da 2 ,-baeper command bytea tchg + cmd) Clime MUST follow 



Crime ds 1 

Flagl ds 1 
XFRFLG equ 480 
EFLG equ $40 
;LRG equ $20 
;HFLG equ »10 



;count of beeps MUST Foilow Btima 

.-Sit flags & constants. Bog2 - 4 MUST FOLLOW in RAM 
- :Xoff received 
;input echo on 
;line feeds 

;hox input :r»t used since commented out in Hex-to 



;NFLG equ *02 
;CBRG equ $01 



.negative on input ;not used, commented out if 
.-debug print outs 



Fl*g2 ds 1 
;RRFLG equ 480 



HLTFLG equ S80 



:Bit flag & constants. MUST foilow Ragl !! 

;Rul« in RAM being used, DON'T OVERWRITE unless clear I 

;not needed sinca T1M1NT 1SR scans up to fired rule 

.before returning. 

:hait the rules (ban test) 
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323 


0040 


FRFLG 


oqu $40 


;just fired a rule, shorten* scan so glitches & loops 










;visitto And allows FORCER a quick exit when dona 


32S 








.■basically on« rule fires par TJMINT. 


326 


OO20 


MFIG 


equ $20 


;!ockmode changes <mustuss FLAGS keyboard command) 


s 328 






equ $10 


;we're Forcing a rule flag (forcer) 


329 


oooa 


CFLG 


equ $08 


;Change of rule $, bkgnd prints new # if SET 4 clrs bi 










,-Path found flag (scan) 


331 


0002 


SFLG 


equ $02 


Scanning rules (timint) flag, prevents recursive ints 


332 


0OO1 


TFLG 


aqu $01 


;Tune flag. No state changes permitted if SET 


333 










3 ^c 












no \ 


Flag3 


ds 1 


•Six fields for rules to use. MUST PROCEED Hag4 










;Spare flags, cleared at power up MUST FOLLOW fiag3 


337 








,6 339 


0044 


Msbb 


DS 1 ;Mo< 


st significant byte of keyboard input values 




0045 


Lsbb 


OS 1 ;Lsb 


* * *. MUST FOLLOW Msbb 


340 










341 


0046 


Lent 


.OS 1 ;line 


count, MUST precede Uth 


342 


0047 


Uth 


OS 1 ;Iin» 


length for M£MOMP, MUST follow Lent 


343 


0043 


Acnt 


OS 1 ;wh. 


»ro print header function starts counting 


20 344 








34S 


0049 


Dtemp 


DS 2 ;D«rive scratch apnea (addd). @@@ uea stack?? 


346 










. .. 347 
348 


-0048 


- K4\mr 


" OS 2" " wwifirw memory facing iajuittd-fAOJwtt. TUNE usesT" 


349 

25 3 SO 


0040 


Tmot 


OS 1 .Temporary motor output value during tuning 


351 


OOSO 




ofg RS + S50 





3S2 
3S3 
354 
355 
356 
357 
35S 
359 
360 



equ 1 6 .-index to start of newest data 
ds DSIZ ;Past 2 blocks A/0 data. Lowest* 
ds 18 ;Currant analog data & d 



;<3> could save bytes if derivatives orriy 



£ AO, Highest "newest A7. 
I hare 

m 4 channels 



0070 

0070 
0072 
0074 
0078 
0078 
007A 
007C 
007E 



.setup in advanca of changes to TIMINT to handle 
org US + $70 



Mtime 
0c2bm« DS 2 
0e3trme OS 2 
Oo4time DS 2 
0c5ome DS 2 
0C2ticp OS 2 
0C3ticp OS 2 
0C4ticp OS 2 
OCSticp OS 2 

BAMENO: 



;Motor time. Same as 0C2 

;0C2 PW current motor timar • 

;0C3 PW 

;0C4 PW 

;0C5 PW 

:0C2 tick/phase 

;0C3 tick/phase 

;0C4 tick/phase 

;0C5 tick/phase 

equ $ ; visible marker 



4 trains simultaneously 

(LD_MOTOR & TIMINT) 
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so 



25 



375 




; " * * • I/O Sorter definitions 






;<g>@@ this cars be reduced to byte pointers & indexing since rem < 25S. 


373 




; redesign En-quo/de-que to bo dynamic sued end plac«<ll NO IN BED ED CONSTANTS! 






; But first v»e get the Sucker to work. 


375 






- 


376 


0080 




$80 ; I/O Vers start Here 


377 


0080 


BUFFS equ 5 


.'Buffers start here 




0020 


0UTS1Z equ S20 


; Output size, 32 bytsa or so 


179 
379 








380 


0080 


OUT BFSTA 


da OUTSIZ :C start at buffer oddroee 






;OUT_ BFSTA 


equ BUFFS ;C start of buffer eddreea 


382 


009F 


OUT_BFENQ 


equ OUT_BFSTA + OUTSIZ-1 ;C end of buffer address 


383 


001F 


0UT_3FMAX 


equ 0UT_8F£ND-0UT_BFSTA ;C almost full circular buff at 


384 


0000 


0UT_BFM1N 


equ $00 ;C almost empty C3 


385 








388 


00 AO 


tOSTR equ 5 


.-vers started here 


387 








338 




Out_hdptr 


OS 2 .-Out buffer head pointer 






Outjiptr OS 2 


;Out toil pointer. Points one behind valid data 


391 




Outjlffil OS 1 


jOut buffer fill (1n_bffii MUST follow. STO in SCHN!) 




00 


tr»_Wfil OS 1 


;)n buffer fit! {MUST follow OutJiffH) 


zz 










tn_hdptr OS 2 


;ln buffer head pointer 


- 9S 


00A8 


., . Injipir .OS. 2... 


.;ln..buffer_tail.ppfOWr., _ _. . _ . 


396 








397 


OOAA 


IOENO equ » 




39S 


0016 


INSI2 equ 320-llOEND-ICSTR) .-Input size-block size - vers used sue 


399 




wo steel byte* 


from input buffer since almost alwaya empty. 


400 








401 


OOAA 


IN BUFSTA 


equ t ;C start of buffer address 


402 


OOBF 


1N~BFEND 


equ IN BUFSTA fiNSIZ-1 ;C end of burter address 


403 


0011 


1NJ3FMAX 


aqu IN VEND-IN_BUFSTA-4 ;C elrnost full Circular Buffer * : 


404 
405 


0000 


INJ3FMIN 


equ 300 ;C almost empty CB 


406 




.pofl* 





35 
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♦ START OF EPROM * 



;subr to update EE from i 



o normel to keep branches happy 
im if dates differ 



idd EES 
cpdEE 
b«q rpbrot 



bar RUDATE 
bsr r««2nd 



:new ROM date 
;with currant Date 

;not different (DATES) so no need to change el) 

:SFB03 :FROM ROM 1 it time.S30*.E/1 3/1 >9600 S34-E713/16 

;clr EVa sci flip flop to enable com Tic 
;al1ow int'a so data can got out 

;do 258 

:next 256 

;siop mts until iimer/mode inits done 



:* * * • subroutine catted to update EE with EPROM n. 
RUDATE: Idx fuvmsfl .inform 

jar PMSG ;usar 



Idx Srcedr 
beq rpbret 
cpx *E£ 



.-current source in ram (EE wn'te adri 
.•nothing to save, AN ERROR 
.-where EE sits 
.not EE, skip itl 



rpcomp: Idea 0,y ;get current ram date 

empa O.x compare with previoua saved EE 

beq rbdec ;same so skip pgming this byte 



psha 

jar H0UTC2 



;save current pi 
;save data 



50 
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;did wo ONLY NEED an ERASE? 
;yes, skip pgmg 



Idab #92 ;program 
bar rpba ;now 



474 puty ;racov«r«m 

475 pulb . . ,. 

476 , 



dflcb ;and count down 

bn« fpcomp ,-until wo 



• •••* C Q<ia eompraaaion subr 
rpba: ifdaf COPON 

jar copaat ;rosat cop 

alM 

Wy #2200 :2500* 10 m«ac<8> 4cy/dey 3333-10m«o<5@3/dax + 3/bne 



;B sat to araaa or pgm cmd, V with delay vaitia, and X pointing t< 

; A with valua to pom 

;rpbaa: 

atabRPROG ;sat EELAT 
staa 0.x ;writa or araaa @ x 
inoPPROG ;EEPGMup 
?wt10: day ;count down 

bna 7wtt0 ;untii dona 

cif PPROG finished 



503 

504 uvmag: db "Updating EVE" + »80 

505 

506 ;•*** and of ERUOATE 
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509 


F800 


5)0 




51 1 


F8C0 


512 




513 




514 


FS00 


515 




516 




517 




518 




519 




520 




521 




522 




523 




524 




525 




526 




527 




528 




529 




530 




531 




532 




533 




534 




535 




S36 




537 




538 




539 




540 


1011 


541 




542 




543 
544 




545 




546 




547 




548 




549 




551 




552 




553 


tool 


554 


oooo 






556 




557 
S58 




559 


0080 


560 




561 




562 


0080 


563 


0080 


564 


0040 



org EES :Rules start horn 

RULSTRT equ EE ;working EE is here 

1NCLU0E O:\A681 1\RUL£\ASM\BHUL29.ASM ;s«t of rules 
INCLUDE ASM\BRUL29A,ASM ;new sot of rules 

INCLUDE ASM\BRUL30.ASM ;K«!ty's name 

14:40 11/12/91 
Base Rules SRUL30.ASM 

Example of RULE30 definition based on 01/15/91 baeeml updated to 4/30/91 
24 rules possible in this configuration, 3 modes supported, ell dynamic 
Revison History 

1/28/91 added battery rule, HDR's 

2/4/91 MB1AS. BORATE & SDRATE added in after able EE 

2/1 9/91 Fixed arror in Mode table RULES has no cond :. OONT SCAN ITT 

2/22/91 Increased size to 24 address & added spare byte to existing roles 

2/28/91 Added demo digital rules 

3/12/91 Adjusted rule values to new defaults 

3/37/91 Add structure for Rags in rules 

4/04/9 1 Reverse order of Forced rules & timer to add Inhibit rules 

4/9-12/91 Worit on battery rules & refinements 

4/30/91 KBJ Remove unused rules 

5/03&9/91 Rework canary njles 

5/22/91 Add NCOL for debug width 

11/12/91 Changed soma values for four Tony Samps lea 

11/14/91 rules for separate sit and stairs 

pU1>lic'0ATF,NUMRUL,NUMM00iBreNT,M8IAS;MODEOOi8ORATE,CHNLST- 
public SUBAOR 
jevorything els* should be computable from tables as offsets 

; • ' * Configuration defines 

ifndef RULSTRT ;<f not defined, must be separate assembly 
;RULSTRT EQU SB600 ;likeiy address if sepa 
RULSTRT EQU *F800 ;l*ety address if separata load 



BRATE EQU *30 
;BRATE EQU $32 
Btjma sou 430 
;EE oqu 48600 
EE equ 4F800 

u RULSTRT 



.usual baud rata 9800 
;usuol baud rate 2400 
:stt» hara for now 
,-usual if stand alone 
,-usuat if stand alone 
defaults saved hare 



; extern Stime,Curmbf fix errors 
curmbf aqu el 2 ;force a fix for DUMB assembler 
stime eoju»18 ;forc« a fix for DUMB assembler 



O aqu RULSTRT-EE jdifference for absolute 

;REVERSE aqu 1 ;defme if channel order reversed 

;Moy just use CHNLST to change em. 

FIN EQU *80 ;Add to final rule # in possible routes list 

; We need soma definitions to aid later specification of Digital rules 
DIG EQU 980 ;B»t high In first byte of rule if digital bits present in rut 

B7 EQU 480 ;MSB 
B6 EQU 440 
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0020 B5 EQU $20 

0010 84 EQU $10 

0008 S3 EQU *08 

0004 B2 EQU $04 

0002 B1 EQU $02 

0001 80 EQU $01 ;LS8 

;0igital rule form is: 

;DBB88BBB ;D - 1 , 3 -Bit* that matter -1.0- don't car*. 
IxVVVVVVV ;Logic state (Value) for selected bits to meet condition. 
• these two bytes present only if digital conditions are used. Dig bit ID) hig 

h 

; in first byte of rula. 
0000 ANA EQU $00 :ANaLog. Dig bit low 

0040 CHN EQU $40 ;CHaiN bit high for additional analog condition* 

0020 GTV EQU $20 greater Than Value 

0010 LTV EQU $10 ;Less Than Value 

OOOO EQV EQU $00 ;EQ*I Vaiua {don't use generally. GT or IT safer since exact 

.match not reliable on analog input*. 
0030 NEV EQU $30 ;Not Equal Value 

OOOB DVT EQU $08 ;D*riVaTrve (time 20 Msec) 

007F NONE EQU $7F jSpecial case, ANt + CHN-t-N£V + 0VT + CH7 it DONT CARE state 

;!tl No value follow* a NONE condition. Ill 

|01| IFNDEF REVERSE , If not reversed 

,-Anaiog input-chsftne» nun 
;m«k«* redefinition easier 



590 


0000 


• CHO 


EQU 0 


591 


0O01 


CH1 


EQU 1 


S92 


0002 


CH2 


EQU 2 


593 


0003 


CH3 


EQU 3 


594 


0004 


CH4 


EQU 4 


595 


0005 


CHS 


EQU S 


596 


0O06 


CH6 


EQU S 


S97 


0OO7 


CH7 


EQU 7 


598 


0000 


KO 


EQU 0 


599 


0OO1 


to 


EQU 1 '; 


600 


0003 


BATT 


EQU 3 


601 








602 


(Oil 




ELSE 


603 








604 




CHO 


EQU 7 


605 




CHI 


EQU 9 


606 




CHZ 


EQU 5 


607 




CH3 


EQU 4 


608 
609 




CH4V 


EQU 3 




CHS 


EQU 2 


610 




CH6 


EQU 1 


611 




CH7 


EQUO 


612 








613 




KO 


equ7 ; 


614 




LO 


equ 6 ; 


61S 




TO 




616 




T1 


equ 5 ; 


617 




BATT 


equ 4 



EQU « ;make* redefinition easier 



' end conditional 
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621 






622 






623 






624 






625 






626 






627 






628 






629 






S30 


F800 




631 


PflOO 


11 14 91 


632 






633 


F803 


30 


634 


F804 


30 


63S 


F805 


40 


636 


F806 


OF 


637 


F807 


31 


63S 
639 






640 






641 






642 
643 






644 






645 


F808 


11 


648 






647 


F809 


17 


648 
649 






650 








FSOA 


03 


652 






653 






654 


FSOB 


03 


655 






657 


F80C 


02 


659 








F80D 




661 






662 






833 
6S4 






665 


F810 




666 
667 
668 






869 






670 






671 


F810 


71 


672 


ran 


£0 


673 


F812 


00 


674 






675 







start of Rule taWe in EEPROM 
; Rules itay in EEPROM unless modified. 

; RULRAM bit fiefd determine if a ram copy of a rule is used since 
; is very scarce in single chip mode. 

; Modified rule* ere saved to EE when a different rule is selected 
; for modification. 



; START OF DATA ••••• 
ORG RULSTRT 

DATE: DB S11.414,$91 ;in HEX II 

BORATE: DB BRATS ;Beod rate saved here to permit change* 

MB1AS: DB 430 ;Motor bias stored here. Thi» « current 11/14/91 value 

MSAFE: OB *40 :Safe motor vaiue used by BATTERY to lockup cylinder 

BRUM OB 40F .Battery shutdown rule to fire after timeout 

BPVAL: DB431 .-Beeper value for battery 

.NUMber of HULea in table. This determine how high the search procaedes, 
;ANO how many bytes are set aside for RULEADR's end RULTIM's. 
;spece for RULADR'e ie ei<act-2*NUMRUU 

;space for RULT1M ie modulo 8, ie. 1-8 - 1B.9-1 6 -28,17-24-38 etc. 
;Ditto M00E00, etc. 

NUMRUL: OB 41 1 ;ia»t rule # scanned. 24 rules max in this confrg. 

; Limit of scan. .. _ . 

MAXRUL: DB 23 ;Ma»mum legal rule #0-23 " ' "\~ 
;NUMber of MOOee. This mokes ■ dynamic upload without relink possible. 
;since ail addressee can be computed as offsets from RULSTRT. (but aren't yet) 

NUMMOO: DB 403 icurranriy 3 supported. Limited by EE space & rule size. 

BFCNT: DB 403 ;# bytes in bitfwlds since we could have more bit fields than 

;NUMRUL would indicate. Applies to MOOEs. RULTIMa. RAMRUL 
NCOL: db 42 ;# coJtimn* to print during debug 

;CH«Nnel UST allows dynamic redefinition of Input channels without having 
,-to mess with rules. Allows ue to fiddle between system* easily 
CHNLST: 

; DB 410,432,454,476 .-forward sequence 
; DB 467,44S,»23,401 ;reverse 



ORG RULSTRT + 410 .Keep positon stable if addition bytes added 
;above (0 free) 

;RUL«* with TIMe constraint*. Sit field here saves space & speed 
;Binary field with MSB of lowest byte » RULEOO. LS8 - RULE07. etc. 

RULTIM: OS %01 1 10001 ,-00-07 ;01 .02,03,07 have timer 
08*11100000 rOB-Of , -08,09,0a haw tjmtf 
OB %0OO0OOO0 ,10-17 

;RUtes with FLaOa oa conditions. 



24 



EP 0 549 855 A2 



67S F813 OO 

677 F814 OO 

678 F815 00 

679 F818 
680 

681 
682 

683 F816 7F 

684 F817 2C 

685 F818 00 



688 F819 00 

689 F81A 00 

690 F81B 00 
691 

692 

693 F81C 00 

694 F81D 00 
635 F81E 00 
896 



697 



714 

715 
716 
717 
718 



F81F 

F81F FS51 

F821 F8S5 

F823 F8SF 

F82S F866 

F827 F872 

F829 F976 

F82B F87C 

F820 F880 

FS2F 
F831 

FS33 F892 

F835 F89S 

F837 F89B 



F88D 



722 
723 
724 



RULFLG: DB %00000000 ;00-07 ; have rla 0 words 
OS %O0OO0O00 ;08-0f ; 
OB%00000000 ;10-17 

;Bit field of active rules for a divert mode. Seme DEF'N * 
:For 24 rules. 3 byte* required. 
MODEOO: ; $ FO ; N 0 R M AL OPERATION 

DB%0ini111 

DB*>ooionoo 

OB %00OOOO00 



IMAL OPERATION 

,-00-07 :01. 02,03,04,05,06.07 active condition* 
,-08-Of ;OA,OC,00 active conditions 
;10-17 



F83F F8A4 
F841 F8A7 



F847 F8BF 
F849 F8C7 



MOOe01:;*Fl 

D8%00000000 ;00-07 

OB%00000000 ,-OS-Of 

DS%00000000 ;10-17 

M00E02: ;4F2 

DB %00000000 ;00-07 

0B%00000000 ,-08-Of 

08%00000000 ;10-17 

;@ or use Flag bits to inhibit/enable rule* 0£ & OF. 

; end so on for additional mode* 

;NpTJ!J Ajule^a STATE number i* determined by ita POSITION in THIS tab 
"•NOT its name (e C RULOA). This makes chosing dtemme rula«Te*iy, ja*f 
;pyt the alternate*' address in tf 



DW RULE0O-0:00-07 
DW RULE01-0 
DW RUU02-0 
DW RULE03-O 
OW RULE04-0 
DW RUt£05-0 
DW RULE06-0 
DW RUUE07-0 

DW RUU03-0;08-OF 
DW RULE09-O 
OW RULEOA-0 
DW RULEOB-O 
DW RUIEOC-O 
DW RULEOO-0 
OW RULEOE-0 
DWRULEOF-0 

DW RULE 10-0:10-17 ETC. 

DW RULE! 1-0 

DW RULE12-0 

DW RULE13-0 

DWRULE14-0 

DW RULS1S-0 

DW RULE 18-0 

DW RULE17-0 



25 



EP 0 549 855 A2 



.List of subroutine eddressos. Accnssed by output veiuea 4F8-4FF. 
SUBADfl: 

OW SUSOO-0 
DWSUB01-0 .-etc 
;usars responsibility to NOT call non-existent subroutines! 

.'List of data tables for output; Accessed bv output values 4E0-4EF, 

;NOT impiimented for Kelly's version 

DATAAOR: 

; DW OAT0O.0AT01 ;etc 



745 :* * * Start of main part of rule table * * * * 

746 ; Maximum number of rule* si 1 28, named from J OQ to »7F 

747 ; RULEOO <* fired at power up and restart. 

748 ; It should not be in active mode list. 
749 

750 ;flULEOO: 

751 ; DS 400 + FIN ;fJo previous rule (startup) +- final rule in li»t 

752 OS NONE ;N 0 condition. 

753 ; 08 *F0 ; Invoke mode change to 0, but no output value to mot 

754 ; D8 *01 ;Ru!e to atari with in now mode. Thi» byte ie unique 

755 ;to nwd« rule* (4FO-F7). It IS NOT TIME! 
756 

757 - - RULEOO: : BATTERY LOW (special rule doe» not appear to fire) 

758 F8S1 SO . DB SOO + FIN ;No previous route* 

759 F852 13 DB ANL+- LTV + B ATT ; Analog, Less than. Battery 

760 FS53 90 9TVAL: OB $90 ;5.28" volts 

761 F854 FS OB $F8 ;Cail subroutine 
762 

763 RULE01: ;START 

764 F855 05 DB SOS :#5 ;possib)a route* 

765 F8S8 08 OB 406 ;#6 

766 FB57 09 DB 409 ;#9 

767 F8S8 OC DB 40C ;#C 

768 F3S9 90 DB410 + F1N ;*10 + final 

769 F8SA 10 DB ANL + LTV + KO ;Analog, Leas than, Knee 

770 F8SB 09 DB 409 threshold 

771 FSSC 48 DB 448 .-Output value 

772 F8S0 OF DB 40F ;Foree rule F if... 

773 F85E FA OB 4FA ,'Timo limit of 250 * 20 msec « S.O sec 
774 

775 RULKJ2: ;KN EE FLEXION 

776 F8SF 01 OB 401 ;#1 :po«*ible route* 

777 F860 8F DB 40F + RN ;IP *■ final 

77S F861 20 OBANL+GTV + KO lAnaiog, Greater than, Knea 

779 F862 OA OB 40A jThreshold 

780 F883 57 DB 467 ;Output value 

781 F864 OE DB 406 :Foree rule £ if... 

782 FB6S FA DB 4FA ;Time limit of 250 ■ 20 maao - 5.0 sec 
783 

784 RULE03: 



F866 01 DB 401 

786 F867 02 OS 402 

787 F868 00 D8 400 



£5 
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788 F869 OE OB $0E ;*E 

789 FB6A 8F OB SOF + F1N ;#F * fin*! 

790 F868 SO OB ANL + CHN + tTV*KO ;Chain, Analog. Lesa than, Knee 

791 F86C OF OB J OF ;Threshold 

792 F86D 21 OBANL + GTV + LO .-Analog, Greater than, Load 

793 F86E 9A OB 49A ;Thf«flhoid 

794 F86F 32 OB »32 :0utput 

795 F870 01 OB $01 ;Force rule 1 if... 

798 F871 2A DB *2A ;Time limit of 42 * 20 msec - 0.84 »c 
797 

798 RULE04: :FL£XiON ■ 

799 F872 83 0BS03 + FIN ;*3 + Final ;posaiWe fouw 

800 F873 20 08 ANL+GTV+KO ;Ar»log, Greater than, Knee 

801 F874 18 0B*1B ;Thre*nold 

802 F875 32 OB $32 ; Output 
803 

S04 RULEOS: ; TERMINAL FLEXION 

805 F878 84 OB 104 + F1N ;#4 + final ;poaaible route 

806 F877 58 DB ANL + CHN + LTV 4-DvT + KO :Chain, Analog, Uee then. Derivative, Knee 
307 F878 FF DB-»1 :Thr«»hoJd 

808 F879 28 OB ANL+GTV + DVT+KO ;Anaioa. Greater than, Derivative, Knee . 

809 F87A E2 DB 1E2 ;Thfesho4d 

810 F87B 32 DB *32 lOutput 
81 1 

812 RULEOS: ;STUM8U 

813 F87C 85 DBJOS + RN ;#5 + Final 

814 F87D 28 - ~ " DB ANL +GTV * DVT-+ KO •-- 

815 F87E 02 OB »02 .-Threshold 

816 F87F 53 OB »S3 ; Output 
817 

SI 8 RULE07: ;SMALL HEEL LOAD 

819 F880 02 OB $02 ;ll ;poesi.M« rautea 

820 F881 OC OfliOC ;#C 

821 F8S2 8E DB JOE + RN ;#E + Final 

822 F883 11 OB ANL + LTV + LO ; Analog Leas than, Load 

823 F884 3B DB 436 ;Thre»hoW 

824 F88S 57 OB »S7 .Output 

825 F886 08 DB *08 ;Fot« rule 8 if... 

826 F887 32 08 J32 ;Tima limit 50 * 20 msec - 1.0 1 
827 

828 RULEOS: ;SIT DOWN (forced) 

829 F8S8 80 08 400 + RN ;N<S previous routea 

830 F839 7F DB NONE ;No conditions 

831 F88A 4£ 08 »4E ; Output 

832 F888 09 DB »09 ;Forca rule 9 if... 

833 F88C 64 08 964 .Time limit of 100 • 20 msec » : 
834 

835 RULEOS: . ;SEATED 

836 F88D 80 08*00 + FIN ;No previous routes 

837 F88E 7F DB NONE ;No conditions 

838 F8SF 32 DB 132 ;Output 

839 F890 10 08*10 ;Forca rule 10 if... 

840 F891 FA DBsFA ;Time limit of 250 * 20 msec - 
S41 

842 RULEOA: ; LARGE HEEL LOAD 

843 F892 87 DBS07-FIN ;#7 + Rnat ;poasible route 

844 F893 11 08 ANL + LTV + LO ;Anelog. Leas than. Load 
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845 F894 2A 

846 FS95 57 

847 F896 OB 
84S F897 32 



851 F898 80 

852 F393 7F 

853 F89A 49 



801 

862 F89F 07 

863 F8A0 8A 

864 FSA1 21 
S6S F8A2 40 
866 F8A3 OO 



DB 42A ;Throshold 

08 457 ;Output value 

OS 408 ;Force rule B if... 

DB 432 .-Time limit of 50 • 20 msec - 1 . 

i: ;STAIR DESCENT 

DB 400 + FIN ;No previous routes 
OB NONE ;No conditions 
08 $49 ;Output 

;: ;STAIR SWING 

08 408 + RN ;#8 +■ Final ;pos«ible route 

09 ANL + LTV+K0 ; Analog, Lass than. Knee 
08 426 ;Thro«hold 

08 457 .-Output 



): ; FALSE HEEL LOAD 

08 407 ;#7 ;posaible rou: 
OB 40A + FIN ;#A + Final 
08 ANL+GTV+LO* .-Analog, Gr< 
DB 440 ; Threshold 

■ 08 400 ;Outpot 



RULEOE: 
RULEOF: 
RULE10: 



;SHUT DOWN 
;SHUT DOWN 
;SHUT DOWN 



871 F8A4 80 


OB iOO+lN ;Wpreviotj» 




872 F8A5 7F 


DB NONE ;No conditions 




873 F8A6 00 


08 400 ;No output 




874 






87S F8A7 FFFF FFFF FFFF 


RULE11: Dw 4FFFF.4PFFF.9FFFF.4FFFF 


;somo blank space 


F8AD FFFF 






876 F8AF FFFF FFFF FFFF 


RULE12: Dw * FFFF,* FFFF, » FFFF, 4 FFFF 


;aom* Wank space 


F88S FFFF 
877 F8B7 FFFF FFFF FFFF 


RULE13: Dw 4 FFFF, S FFFF, $ FFFF, 4 FFFF 


;some blank space 


F88D FFFF 






878 F8BF FFFF FFFF FFFF 


RULE14: Dw *FFFF,4FFFF,$FFFF.$FFPF 


;some blank apace 


F8C5 FFFF 






879 F8C7 FFFF FFFF FFFF 


RULE15: Dw SFFFF^FFFF^FFFF^FFFF 


;some blank space 


F8CD FFFF 






880 F8CF FFFF FFFF FFFF 


RULE16: Dw S FFFF,* FFFF,! FFFF. S FFFF 


;some blank space 


F8DS FFFF 






881 F8D7 FFFF FFFF FFFF 


RULE17: Ow 4FFFF,9FFFF,$FFFF,*FFFF 


,-soma blank specs 


F8DD FFFF 






882 






883 ;addio 


onal rules would faquir; that RULNUM be ra 


■ed, end additional 


884 ;bit fit 


dd byt« for RULT1M and MODExx b« added 


& DW's for RULAOR's 



885 
836 
887 

888 F80F 

889 F8DF 7DO0 17 

890 F8E2 26 0£ 
891 

892 F8E4 IS 12 40 

893 F8E7 4F 

894 F8E8 F6 F8 07 



and D/A table* would go here if used. 



tst Stime + 1 ;runninc. already? 
bne nobt ;yes, don't mess up 



bclr <{curmbf},S40 ;teke rule 1 out of scan 

;no old beep command 
Idab 8PVAL ;the value to beep 
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895 


F8EB 


0D 30 




396 


F8 ED 


CC 1 7 70 


jdd #6000 .-shutdown time out 


897 


F8F0 


97 16 


staa Stiroo ;make it run 


898 


F8F2 


39 


nobt: rta 


899 








300 








901 






n rnn 


902 






DAT01 • 


303 


F8F3 




£ND_BASE: 


904 
905 


F8F3 






906 








907 








908 


1O03 


DIG IN equ PORTC ;tor now 


909 


1004 


OIGOUT aqu PORT8 


910 
911 








912 


F900 




org ROM ;Code starti hero 


913 








914 








915 






■ ■ _ , . . .- 
; Main Command Jump Table. Consists o yte ow by rose o is 


916 






; Searched sequentjaiy so put moat likely commands nrsiin Hit 


917 






; 01/1 1/91 Redefine elements & routine* 


918 








919 


0O03 


Ea^*** 3 •current element size for CMDOISP 


920 






CMDTBU* **S &i A Qare handled by Rxint/Txint 


921 






^ S mi?m f€at character 


922 








923 


F900 


41 


diT'A -Adjust values in rule table 


924 


F901 


FD45 


dw ADJUST 


925 


F903 


44 




926 


F904 


FF80 


dw OUMP i~ 


927 


F906 


45 




928 


F907 


F02E 


dw ENTER 


929 














dw PAULS 


,1 


F909 


12 




932 


F90A 


F8£2 


dw BEGIN 


933 


F90C 


54 


db T ^ TUNE TUne m ° t0f Valu *** S,0f> * Ad J u,u rr,ot0f j- 




F900 


F09F 




935 






db 'R' ,- Recall parameter set # 


936 






; dw RECALL 


937 


F90F 


53 


db 'S' .Save RAM to EE 


938 


F910 


FCAC 






F912 


40 


db Tut' ;M«morv dump @ address 


<ijn 


F913 




dw MEMDMP 








db *7' ;Help. Display fiat 










943 






• dw HELP Free up mode etiance 
■ dw FREMOD 


944 

945 






db V .Lock to a mode 


946 






; dw LOCMOO 


947 


F915 


46 


db *F" ;HBfl» WflQie 


948 


F916 


FFB3 


dw FLAGS 


949 






; db T'-»4© rTest 


950 






; dw TEST! ;tast routines 


351 


F918 


80 


db » 80 :ond of table character MUST be »80 



29 



EP 0 549 855 A2 



954 
955 
956 



F91C 
F91D 
F91F 
F920 



962 
963 
964 
965 
966 
967 
968 
96$ 
970 
971 
972 
973 
974 
97S 
976 
977 



F922 
F923 
F9Z5 
F926 
F92S 
F929 
F92B 
F92C 
F92E 



e far reel time commands 



« DECVAR 



dw tNCVAR 
db ESC ;escape loop 

dw ESCEXIT 
db " "escape 
dw ESCEXIT 

db '.' .-escape 
dw ESCEXIT 

db'>»' ;direct assignment 

dw SETVAR 
db ' + ' ;ine addresa 

dw INC ADR 
db '•' :dac addraaa 

dw DECADH 
db ':' ;sst address 

dw SETADfl 
db »80 ;end of table 



; RTDSPH. real 
; < > inc/dee value, +■ - ino/dac address being 
; Returns to one ABOVE eadtw tf ESC, SPC. .. «i 

; Ecnoa variable value for each-step - - - — 

; fails into CMODISP 

; X is cellars address on return to MAIN 



RTDSPH: ; 

Idx IRTTBL 
;FALL INTO CMODISP-.. 



;Raal Time command TaBle 



992 

993 F932 

994 F932 CS03 

995 F934 20 01 
996 

997 F938 3A 

998 

999 

1000 F937 

1001 F937 60 00 

1002 F939 28 OA 
(003 

1004 F93B A1 00 
T005 

t006 F93D 26 F7 

1007 

1008 



;CMDD!SP. commend dispatch from tobts of input chert - : 
;X points to table head. A has char to check for match. 
; If »80 at end of table found, aeta Carry. CMD not found. 
; X & 8 altered initially. Commend* do whatever... 

CMOOISft 



o middle. Fewer branches inside loop it faster 



;sdd S to X to get to next table entry 
use $80 es ftsg & bva to find end 



rt 0,x 



:end of table is $80 
;ye». Cmd not found 



bmi cmderr 

empa 0,x ;byta match? 

derr 

bne cmd ma ;get next entry 

;preloed for toggle function* 
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Idx 1 , x ;get address of found command (@X + 1 ) into X 

psrut' ;sav« on stack 

Idx Adjadr .-preload for smaller RTDSPH coda size 

jmp 0,x ;and do it. Colled procedure doas rts to main loop 

rts ; which is realty a jump to taWo entry on stack I 

cmdarr: sec ;set carry 

rt« ;retum with error 

IS 
20 
25 

30 - ' . . ,V.C 

35 

40 

45 

50 



1009 F93F EE 01 

1010 F941 3C 
1011 

1012 F942 DE48 
1013 

1014 

1015 F944 39 
1016 

1017 F945 OD 

1013 F946 39 
1019 

1020 
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F947 

F947 CE 10 00 
F94A 1D 23 7F 



F94D icooso 



F9S0 3C 

F951 CE 00 50 

F954 C6 08 



1021 
1022 
1023 
1024 
102S 
1026 
1027 
102S 

1029 
1030 
1031 
1032 
1033 
1034 
1035 
1036 
1037 
1038 



1040 F959 1AEF00 
10*1 

1042 F9SC 08 

1043 F9S0 08 
1044 

1045 F95E 5A 

104S...F95E. -28-F5 

1047 
1048 

1049 F961 33 

1050 

1051 

1052 

1053 

1054 

1055 F982 1C30 04 

1056 

1057 

1058 

1059 F965 EC 31 

1060 F967 00 60 
1061 

1062 F969 EC 33 

1063 F96B 00 62 
1064 

1065 



1066 
1067 
1068 
1069 
1070 
1071 
1072 



;TIMe INT. OCT ims hare to get wort done 
TIMINT: 

Idx JfflEG :Ba«« 

bclr_TaG1,x.97F :0C1 int fig cleared if high, R/M/Writa 

;since wa should be able to do tNe in under 20maflc, we'll (tenable inta & pra 

; cli ;allow others to int {SCI moatiy tor debugging] 

baet _PORTA.x.48Q ;dbg ratee Rag 0C1 for timing 

bar fsetx ;dbg raise ffag, X ok. 

* FIFO function shuffles old data in rai 
pshx ;sa 
Idx #Rfo ;statt here 
Idab #0SIZ/2 :Ioop count 



F96D EC 16 
F96F C3 9C 40 
F972 EO 16 



bdr _PORTA,x,*80 ;dbg measurement 

bar feint ;dbg dear flag, X ok, 

3 we may want ONE pass on 4-7 to minimize skew between channels 
baet _ADCTL,x,S4 jchancje A/D to 4-7 repeating 
Idea « 1 4 xhanga A70 to 4-7 ONCE 

ataa _ADCTL,X ;now 

Idd _ADRl.x ,get ADR1 ,2 data. A/D must be done after 20msec... 
stdAnkfat ;Muft 1,2 



.since we should be able to do this in under 20meec, we'll reenabie inta & pra 

; cti ;atlow others to int (SCI mostly for debugging) 

Idd _TOC1 ,x ; current time of int 

addd #flTCRAT ;20meec ;@o*e Ram value? 

»tdjrOC1.x ;ur* 



;@ this code should be changed to uae the OCx to raise the output, <«1 to dea 
tdd Mtwrte ;motor width 



SO 
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1075 

1076 F978 E3 0E addd _TCNT,x : add to currant time 

1077 F97A C3O0OA addd #10 ."compensate f of software delay 

1078 F97D ED 18 std _T0C2.x .update ouput compare reg 
1079 

1030 F97F 86 CO !d«a ISCO ;* 0C2 goe* high on compere 

1081 F981 A7 20 staa _TCTU ,x 

1082 

1083 F983 86 40 Ida* #*40 ;0C2 force bit 

1084 F98E A7 OB Uu JSFORC.x .-Force 0C2 high 
1085 

1086 F987 86 80 Idaa #»80 .-next 0C2 will go low 

1087 F989 A7 20 sta*_TCTU,x ; whatever 
1088 

1089 F98B nopul: 

1090 F98B OE cli ,xan now allow ima hare w PW doean't jitter 
1091 

1032 ;?wtad0: brclr _ADCTL,x.»80.?wtadC ;weit for A/0 dene (Just in c« 

so) 

1093 

1094 F98C EC 31 ldd_ADR1.x .flat A0R1.2 

1095 F98E DO 64 std AnWat «■ 4 ;stuff 4.5 
1096 

1097 F990 EC 33 Idd _A0R3\x :gat ADR3.4 

1098 F992 00 66 stdAnklat + 6 ; stuff 6,7 
1099 

1100 F994 10 30 04 - - bdr-_A0CTt. i x-.«04 - -;re*ta*t A/0-to-CH-0-3jfor.T8Maec fromjiow- _ 

HOI Idea #»30 " .-change A/D to 0-3 Repeating 

1102 staa_ADCTt_X .now 

1103 

1104 bset _P0RTA.x,J80 ;dbg timing 

1105 ; °*r faea ;dbg set flag, X ok 
1106 

1107 
1108 
1109 

1110 F997 18 0E16 Idv Some :timing beep? 

1111 F99A 27 15 baq?bat*t :nope 
1112 

1113 F99C 18 09 day ;count out 

1114 F99E 18 OF 16 ity Stinw ;upd«a t*m 

1115 F9A1 260E boa?b*totc ; not YET timed out 
1116 

1117 F9A3 14 41 80 baet Rag2,HLTFUG :«op rulea 

1118 F9A6 86 F8 06 Idea BRUL .the rule t to forca 

1119 F9A9 C6 01 Idato #1 ;in one tio 

1120 F9AB DO 1C std Frcrul ;stuff here 

1121 F9AD C6 0S Idato #5 .-now beep 

1122 F9AF D7 3E «t*to Btime «- 1 .and ihut up beeper with a longar chirp 
1123 

11 24 clrb :need zero 

1 1 25 ; bra cbeep ,*nd »hut up beeper 

1126 ; bra ?betok .skip onward 
1127 

1128 ; Idato MSAFE safety vaiua 

1129 ; j«rLD_MOTOR ;do it now 

1130 ; • bralbatok ;»tdp onward 
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"33 ; Idaa Anldai t 3 -he battery chan 

1,34 ernpo STVAL ;ihe threshold in ; 

H3S ; bhs 7batok ;not too low yat 
1138 

1 1 37 ; idd *6000 ;2 minuta* 

1138 ; std Stimo ;9«tup time out 

1139 ; IdaaBVAL ;gat command 
1 1*0 ; staa Btima + 1 ;startup beeper 
1 141 

11*2 ;; WdSVAL ;b«ep vafua & rep 

11*3 ;; std Btima +1 ;emd & repeat co< 
1144 

114S F9B1 ?t>»tok: 



:@ Thia can be impfovod (how?) 

Idab Btima + 1 



11= S ;?nchc.: ;no ehanoe. must till be timing 

1157 F9B9 1SDE23 Idy Rtime ; 0 et counter 

1158 F9BC 18 09 day :co U m dawn 

1159 F9BE 18DF23 sty Rtime jupdata 

1 1 60 F9C1 26 20 bna ebaep ;cononue. time not op vat 
1161 

1162 brclr SPORT-REG,x.BBtT,ion . ;gnd if baap currantty off , oomputa on 

1163 F3C3 1EO8 20 1O braet BPORT-REG,x,BBIT,ton > + if baap currently off , compute * 



1170 F9C8 5* larfa 

1171 F9CC 54 tsrb 

1172 F9C0 54 larb 

J J 73 26 03 bna offofc ;wa do hava an off time, alia we're dona. 

1 1 75 F9D0 7F 00 3E clrbu dr Btima + 1 ;cloar command. Dorw for now. (fell through for sue) 

1176 ;Btimo + 1- 

1177 F9D3 17 off ok: tba .copy 

1178 F904 30 mui ;tima squared 

1 179 ■ - ■ Idai #10 ;10 V020-.2 sac tie* 

1180 : muf ;tim«low ordarin B 
1 ,a 1 std Rtima ;updata counter 
1182 ; bracbeep relaarbaop 
1183 

1 1 a 4 ;A we couid do repeat count down hare 

11S ? ;& WaaCtima ; eat count 



34 



EP0S49 855 A2 



F9D5 20 07 
F907 

F9D7 ID OS 20 

F9DA 07 30 

F9DC C4 OF 

F90E 86 OA 

F9E0 30 

F9E1 DO 23 



•o don't hova a count 



;continua with 



bset SPORT-REG.x.BBIT ;tu rn on b« epor bit 

bclr SPORT-REG ,x. BBIT ;turn on beeper bit 
stab Btime ;update command change byte 

ondb * JOF ;maik to low order nybble 



mul10: Ida* #10 :10 ■ .020 ».2aec tics 



,ond of beep functions 



F9E3 DC 1C 
F9ES 5D 
F9E8 27 08 



H). Do w« rmd to check SFLG? 

Idd Ffcrul ;gat forcing info, rule I & time 

tatb ,-jmar running? 

beg ?nfrct ;nope, no forced time active 



1215 F9ED 97 20 



;force thia rule (A from LDD) 



1218 
1219 
1220 
1221 
1222 
1223 
1224 
1225 
1228 
1227 
1228 
1229 
1230 
1231 
1232 
1233 
1234 
1235 
1238 
1237 
1238 
1239 
1240 
1241 
1242 



F9EF 3D5D 

F9F1 20 08 

F9F3 86 83 

F9F5 95 41 

F9F7 28 OS 

F9F9 14 41 02 



F9FC 80 OS 
F9FE 15 4102 
FA01 



Idea t'T ;dbg 
ierdbg ;'T 

bar FORCER ;mske it active NOW 

bra endrim ;skip to and. only one rule fired per Ocl int 

?nfrct: Idee #<HLTFLG +TFLG +SFLG) ;floga to check 

bite Rag2 ;inhere 

brtenorule ; blocked. by tune or scan or HALT (bett low! 

beet Rag2,SFLG iprevant recureive ceils to ecen 

bdr flag1,DBFt.G,?d*cn ;dbg 
jerCRLF ;dbg eeen 
Idas ICR ;dbg 
bw dbg ;cr 

?d«cn: bar SCAM ;jcsn rules if not recursive interrupt 

endtim: bclr Rag2,SFlG ;ctear the scanning flag, or forcer deadlock 



bar fclr ;dbg timing 

Idx #HEG ;re 
bclr .PORTA ,x,»80 



.-always end INT with 0C1 cleared 
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;al! don* this interrupt (upprox I.Bmsac totaj} 
flag for debuggfng/rafin< 



1250 ;fclrx: 

1251 ;fsatx: 

1252 ; tdoa_PORTA.X :g«t flag 

1253 : aora#*80 ;«ip 0C1 

1254 ; sua PORTA.X ; stuff it ba. 



ut J»ORTA,X ;»ign? 

bpl f» ;ra«ao sine* down 

bclr_PQRTA,x.$80 ;lo war 0C1 output 



;;fs: bset _PORTA.x.JSQ. 
,15 bytes vs 10 



1 269 ;SCAN, Scans rulaa fc 

1270 ;Modi«t«« att registers 

1271 .-1/29/90 

1272 ; 

1273 db "SCW 

1274 FA09 SCAN: 

1275 ; rta 

1276 FA09 7F00 20. 

1277 FAOC IS 41 40 
1278 
1279 

1290 FAOF CE00 12 
1281 

1 282 FA 1 2 A6 00 7g*tbf : idaa 0,x ;gat active rules bit field 

1283 ; beq ?twaW ;skip it nana at aU. ;low probability, not ensbJed 
1284 

1285 FA 14 48 Jahrbf: asla :bitt into carry 

1280 FA 15 24 OB bcc ?nfula :this rule not active 

1287 

1288 FA 17 3C pshx ;thi* ruia activa, stack 'em 

1289 FA18 3« psha 
1230 bsrtset ;dbg 
1291 

1292 FA19 80 3« .: bar GETRUL : and check rule c< 

1293 : barfctr ;dbg 
1294 

1295 FA 1 B 32 pula 
1298 FA1C 38 pulx 
1297 

1298 FA ID 12 41 40 16 
1 299 
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1300 


FA21 


40 


1301 






1302 


FA 22 


27 05 


1303 






1304 


FA 24 


7C 00 20 


1305 


FA 27 


20 EB 


1308 






1307 


FA29 


08 








1309 


FA2A 


D6 20 




FA2C 


C4 F8 


131 1 


FA2E 


ca 08 


1312 


FA 30 


07 20 


1313 






1314 






131S 












1317 


FA32 


F1 F8 08 


1318 


FA35 


23 08 


1319 






1320 






1321 






1322 
1323 






1324 


FA37 


39 


1325 






1325 






1327 


FA38 


CD 


1 323 


FA39 


02 


1323 






1330 
1331 






1332 


FA3D 


23 07 09 


1333 






1334 


FA3F 


CE FA 39 


1335 






1338 


FA42 


BO F€ 71 


1337 






1338 
1339 






1340 


FA45 


SF 


1341 






1342 


FA4« 


CEF8 IF 


1343 


FA49 


58 


1344 


FA4A 


3A 








1340 


FA40 


39 


1347 






1348 


FA4E 


14 41 12 


1349 






13S0 






1351 






1352 
1353 






1354 






1355 






1356 







;aet CCs 

;nothing left in rag so got next byta 



;m**k out partial counts 10-7) 
;inerero«nt to next whota byta of BFs 
; put it back 



.hit limit? 

;nopa, go ctwck naxt 8F byta 



'noils: be<j Pnxtbf 



Idab Scnrul 
andb #JFS 
adob *ta 
stab Senruf 



Sdaa »'%• ;dbg 
j«0UT_QC ;dbfl 



;mo49«fl«* *t hara for bsr limit* .... ... _ .. 

mdamsg: db"M" + S80 ;mod«arror 

rermsg: db "fl" + 480 ;arror mesaga hara for bar 

;* * * Subr to gat £E addraaa if ruiea (not rami 

GETEDR: empb MAXRUL :limit to pra 

bit ?rnok ;ok (unsigned, but tinea 7f max, naadn't ba> 

Idx #rarrnsg ;arror 
; bar mdeoul ;indiract jmp to PMSG 

jar PMSG ;te« 'am , 

Idab MAXRUL jlirrat it to?? 
Idab #0 

drb ;limit to powaf up rula tinoa *»* hava an arror 

?mok: Idx *RULADR .tatt* start in EE 

aalb ;*2 (or words 

abx ;indax into arfdraaa tabla 

Idx 0.x ;gat addraaa into x 



FORCER: baot Rag2.FFLG * SFLG ;sat Forced & Scanning fl 

lda*#'f' :dbg 



;wa don't want to stack thing* up it Ho goof* and gat* an infinita loop of 
;forc*d rula* so that we jump around & around & around 4 ..... 
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1359 
1360 
1361 
1362 
1363 
1364 
1365 



FAS1 
FAS1 



1371 
1372 
1373 
1374 
1375 
1376 
1377 
1378 
1379 
1380 
1381 
1382 
1383 
1384 



FA5F 

FASF E6 00 

FA61 C4 7F 

FA63 27 04 



1390 
1391 
1392 



FA53 80 E5 

FA55 9C 10 

FA57 26 03 

FAS9 CEOOOO 



;sinee FRFLG sat 10 



; * * subr to get rule from table, cl 
GETRUL: 

bar getacn ;get the rule's address 

...... jyjjf geta addf^j, 0 f fuj,, at Scnml. Sits here for SSRs limits 

;0«tscn: 

Idab Scnoil ; scanned rule t 

;GETADR: 

b*r GETEOR ;get EE nils address 

cpx Srcodr .compare to add rats we may have ir 

brva ?raok ;oK 



FASC 15 4104 



?raok: bcif Fleg2.PaG 
brcir Hagl ,D8FLG,gejpsth 



FA69 14 41 04 

FA6C 60 00 

FA6E 08 

FA6F 28 02 



;clr path found flag 
;dbg printout 



jar H0UTC2 
Idea Scnrui 
jar HOUTS 



;newline & address 
;get rula t 

■dbg 
;dbg 
;dbg 



baq ?piero 

cmpb Curru) 
fan* ?nmteh 

baet Ftag2.PFLG 



;poth of wro speciati, no previous req'd:. Path found 



■i ?lstph 



;F1N flag? 

;% point to naxt path, only Z CC affected 
;yos, last path 



1401 FA71 20 EC 



1404 
1405 
1408 
1407 
1408 
1409 
1410 
1411 
1412 



FA73 12 41 10 04 
FA77 13 41 04 EC 
FA7B ?fvpth: 



• Check FLAG St field & byte 

pshx ;aovo currant poin 

Idx fRULFLG ; FLAGS bit field 
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1413 






1414 






141S 






1416 






1417 






1418 




;@<i 


1419 




;@ 


1420 




;@ 


1421 




;<§> 


1422 






1423 






1424 






1425 












1427 






1428 




;?f% 


1429 


FA7B 


EB 00 


1430 


FA7D 


2A 13 


1431 






1432 


FA7F 


di 3 : 


1433 






1434 






1438 


FA7F 


F4 10 03 


1447 


FA82 


€8 01 


1438 


F A84 


E4 00 


1439 






1440 


FA86 


08 


1441 


FA87 


08 


1442 


FA88 


12 41 10 04 


1443 
1444 


FA8C 


C4 7F 


144S 


FASE 


26 A7 


1446 








FA90 


E8 00 


1448 
1449 


FA92 


art 


14S0 






1451 






1452 






1453 


FA92 


CI 7F 


1454 


FA94 


27 4C 


1455 
1458 


FA98 


12 41 10 3F 


1457 






1458 


FA9A 


C4 0F 


1459 


FA9C 


3C 








1481 






1482 


ton 


1483 






1484 

1485 






1468 
1487 







;cheek flags bit Holds for rule * in Scnrui 



braat Flag2,FFlG,?fvflg 



,-forca valid flag* if *at 
a a* digital rulee. ACTIVE bits 4 VALUES 



IdaaO.x ;get the data byte 

anda Flag3 ;AND in currant flag* 

aora Flag3 ;flip sense of HOT Wt» 

brw nxt ;condition not matched, RTS 

inx ;skip to next condition 

lam: JdabO.x ;naxt condition byta 



Ida* #'d' ;dbg 
bar dbg 



andb 01GIN ;ANO in axtemi 

aorb 1 .x rfiip senae bit* as *pee'd 
andtoO.x ;mask tlwm too for 



inx .-point to analog next, skip tc 

inx ; and analog condition* 

brsat Bag2,FRG.«fltg*t rfore* watid digital. 



>tdb#*7F 
bnanxt 

anlgac WetoO.x ;get analog conditions 



;m*»k out DIG bit 

;Cof>dition not matchod, gat next rul <ju*t an RTS) 



cmpb MUOKE icheck (of don't ear* 

baq fir** ;don't cara analog cond, so spectai fi 

;no treahcW follow* tht* condition! 
brsat Flag2,FFUG,nxtcnd ;forea enatog 



andb #»0F ;m*sk to et 

pihx ;sav« point 

it CHNTBL translator 
«f TRANSLATE ,tran*i*tor oneUad 
I ;aave for bit t«st* 

db #107 ;juat A/0 eft * bit* 



»l bits 01 



Idab0,x ;naw value 
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1470 
1471 
1472 
1473 
1474 
147S 
1476 
1477 
147S 
1479 



1485 



bite #41 ;odd/*ven nybble? 



arab #DVT 
?chok; andb #»0F 
;30 bytes if Y. 27. if X 

endif 

;****• end of Mandator 



;ehanoe io bno to swap nybbtea around 
:sh.fi into low nybble, O fiit <NOT ASRil) 



;raiaa tbit bit, {offaat CH oddro»« by 8) 

.keep within bounda (kill any high nybbl* raaidga) 



1 487 FA9D C5 08 

1488 FA9F 27 03 
1489 

1490 

1491 FAA1 SO FB 92 
1432 

1493 FAA4 CE 00 60 

1494 FAA7 3 A 

1495 FAA8 66 00 
1496 

1497 FA A A 38 

1498 

1499 

1500 

1501 

1502 

1503 

1504 

1505 

1506 

1507 

1508 FAAB El 01 

1509 

1510 

1511 

1512 

1513 

1514 

1515 

1516 

1517 

1S18 

1S19 

1520 

1521 

1522 

1523 

1524 

1525 

1S26 



bitb «8 ;DVT? 
beq ?nodvt 
bra ?nodvt ;dbg 

jar DERIVE 

?nodvt: Idx MnWat 



it derivative for THIS channel into ram table 



:analoo data tabia 
abx ;add in offaat to channel 

Idab 0.x :get data value 

pubt .-recover pointer 

brclr 0,x,OVT,?nobtig ;dbg only DVT inatmctiona 

pahx ;dbg save pointer 

Idea 1,x ;dbg get threahold 

xgdx ;dbg swap to X 

jar H0UTC2 ;dbg and print 

xgdx ;recoverB 

pufot ;dbg recover pointer 



; compare with threehoW and branch a* required 



@ we might try a data table, indexed by 3 bit offaat 
ch coat* 5 * 4 bvtea=20 vs 8 



Ida #3 ,-offaet per branch 
irw) 

addd #7bOO ;baaa 

xgdy ;to Y 

pub ;recover channel* 

Idx fAntdat analog data table 

abx .add in offaat to cht 
IdaaO.x ;get data value 

putx .'recover pointer 
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; compare with threshold and branch <a required 



1532 
1533 
1S34 
1S35 
1536 
1537 
1538 
1539 
1540 
1541 



- 1 3 + 8 for 2 mors beq/bne, r 



i ford 



FAAD 1£ 00 30 19 

FA81 IE 00 18 18 

FABS IE 00 10 08 

FAB9 1 E 00 28 13 

FABO IE 00 20 06 



;, may not be faster «i(h«f . 

way NEV. MUST test BOTH bi 



brast 0,x.430,?bnO ;th 
■ ;ok (or DVT 
br«»t0.x,418.?bO11 :tbie way LTV DVT 

braetO,x,410,7bOlO ;thi« way LTV - BLO 

br»etO,x.»28,?b101 ,thi« way CTV OVT 

brast 0. X, * 20. ?b 100 ;thfa way GTV - BHI 

brclr 0.x.i30,?b000 ;thia way E0.V. fall* through. 

;ok for OVT also 
;W» use hard coded vetuee rather than defined Constanta 
: since coda sequence dependenciee exi at, 
;but the Mowing branch chain aorta it all out 
?bO0O: baq nxtcnd 



1547 
1548 
1549 



?b010: bio nxtcnd ■ 



fblOO: bhi nxtcnd 



?b01 1 bit nxtcnd 



FADO 2E07 
FAD2 
FAD2 39 



7b101 bgt nxtcnd 



;thi» ia bora to allow bar'a for debugging 

;dbg: bfdf Ragl,DBFLG,r«>dbg ;no debug 

; ]mp OUT_QC ;«crK> chara 4 return 



1567 ;s 

1568 FA03 CE FA 38 

1569 FA06 7E FE 71 
1570 

1571 
1S72 

1S73 FAD9 IF 00 40 04 
1574 

1575 FADO 0* 

1576 FA0£ 08 

1 577 FADF 20 AF 



1582 FAE2 08 



ta hera for bar'a 

mth: Idx #mdemig ;@£RR0R ERROR I mode too high for table 
o print out and abort change 



mdeout: jmp PMSO 



nxtcnd: brclr 0,x,CHN,firaa 



;ch*jn?-*40 No, tira analog if wa got tfcjt far 



,-poim to output byw 0«t cood) 
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1583 
1584 
1585 
1SS6 
1587 

1588 FAE3 DC IF 

1589 

1590 

1591 

1592 FAES 40 

1593 FAE6 27 05 
1594 

159S FAES D1 IE 



beq ?kfira 
cmpto Inhrul 



;we want to be here (B-Scrtful follow* Inhtim) 
a currently here 
as lest time so skip firing calls 

;lnhtim it? (A of LOO InhtimJ 
;na inhibit* 

:doe* our scan rgla match the inhibited ruia?<8»Sonnjt 



1597 FAEA 20 01 



1601 

1602 FAEO 50 
1803 FACE 27 08 
1604 

1605 FAFO 07 13 
1608 FAF2 7F00 1D 
1607 

1608 



1612 
1613 
1614 
1615 
1616 
1617 
1618 
1619 
1620 
1621 
1622 
1623 
1624 
1625 
1626 
1827 
1628 
1629 
1630 



bra ?kfire 
Pnfire: its 



;dbg we don't care 

;wo didn't REAU.Y ffr# ih* rule. Look at next one 

fspeeial rula? 

.special rulaM 1/1 2/91 
«e :y«*, don't tat anyone (except SP1) see It fire 

rrul ;so tail everyone of new rule number 

m ;new rule, clear timer. 

;and inhibits? It inh & other fires, do we stay inh'd? 



bset Rag2,CFLG + FRFLG ;teli bkgd & scan of rule nun* 
bclr Rag2.FFLG ;and dear forcing flag 

;@ there is a logical inconsistency hero. Fflg cannot be cleared here, 
and than used for testing just before ddmodet 

;@ No mode change must mean no mode change on forced rules too. 

;® an interesting trap. So how do you get into a mode you want to lock to? 



FB01 58 

FB02 58 

FS03 58 

FSO* F7 10 2A 



FB03 EC 00 
FBOB 81 FC 
FBOO 25 17 



1632 
1633 
1634 
163S FBOF 27 0 



1637 FB11 31 FE 



a rule I to D/A port via SPt 
no***: Idas SPSR 
Idas SPOR 



itabSPOR 

tba ^ibg 
isr HOUTS ;dbg 

stx Outadr 



;;Knock down any SP1 flag* 



"8, 32 max 

;; writ* to SP1 port. 



IddO.x 
cmpa UK 
blo notspi 



;save address of output value for gtimer 



;flagsat function (1FC) 
; Beeper? 



50 



ss 
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1638 FB13 
1639 

1640 FB1S 
1641 

1642 FB17 

1643 FBI 8 

1644 FBI A 
1645 

1648 FB1C 
1647 FB1£ 
164fl 

1649 FB20 

1650 FB22 

1651 FB24 
1652 

1653 FB26 

1654 F826 

1655 FB28 
165B 

1 057 FB2A 

1656 FB2C 



22 36 

25 09 



94 42 
07 42 
20 23 



;flegeif function (*FD) 
;agual am 
;doar out old command (@Btimai 



to date byte Bin 



;*0FP in Flag bit* 



;ae«ciaU? 
;nop», stint 

;aub»? with whati Ian: 



;fall into.domode ;»F0-»F7 

braet Fiag2,FFl.G,dornode .-forcing a rut*? 
0 braet Rafl2,MFl.G.oomc :no mod* change allowed 



1668 FB32 

1669 FB34 

1670 FB37 



1674 

1B75 
1676 
1677 



80 FO 

81 F6 OA 
24 9A 

97 18 

07 20 

F6 F8 0B 



.-change mode labia, callad by LOCMOO alto (maybal 
tuba #*F0 .-subtract baaa 

cmpa NUMMOD ,-limit ia? 

bba mth ;somethirtg wrong, over table to don't change y< 



;1*t rule in new mod* wit) be forced later 



1879 FB41 C3 F8 16 



;gat bit field count 



addd #MODEOO ;add in baae of 1 at table in EE 



1683 
1684 
1685 
1666 
1687 
1668 

1689 FB45 

1690 FB48 
1691 

1692 
1693 
1694 



;Not eupef fart, but tmaflof?? than a LOO 0,y, STD 0,x twice? N 

;it IS univentai for «iie changa* though. 

r; ldy #Curmbf ;2 deat, active rule* in ram 

;: Idab BFCNT ;3 / to xfar 



I't have to worry about inte rw 
jarCOPYM :3 copy 

jar copybf 
jmp FORCER 



e tinea SfLG ahould a 
> ram (domoda) 

;;snvo redundant loada by jumping into COPYR 



LDD 0.x 
STO Curmbt 
LDD 1.x 



Tl get data 18) 
;2 put data 
;2 2nd word 
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STD Curmbf + 2 



.-Digital output ortlv possible in single chip mod* (supposedly) 
;alrhough wa could use unused port A bits 

: Ida* 1 ,x ;gat output pattern 

stab D1G0UT ;output pattern to defined port 
dcont: inc Outadr + 1 .-point to real output for gtimar 

1 704 ;@@ bug if rollover occurs in"iow address byte if >256 EE for rule* 

1705 FB51 20 10 bra gtimer ;digo 
1706 

1707 

1 708 dosubo: ;cell a subroutine tt setup timer 

1709 F853 19 tab ;move value to useful place 

1710 ; Idaa/V 

1711 : bsrdbg :* 
1712 

1713 FB54 CO FS subb #9F8 .subtract ba*« 

1714 FBSe S3 aalb 

1715 FB57 

1716 FBS7 CE F3 4F tdx#SUBADR ;get the besa 

1717 FB5A 3A abx .-index in 

1718 FBSB EEOO Idx O.x .-get the address into X 

1719 FB50 AO 00 jsrO.x ;call it 
1720 

1721 F85F 20 OZ bra gthner ;ster*iard' finish " ~ ~ 

1722 

1723 FB61 domot: 

1724 FB61 SO 13 bsr L0JV1OTOR ;stuff timer 

1725 ; then fail into gtimer 
1728 FB63 giimer: 

1727 FB63 CEF8 10. Idx *RULTJM ;tim*r bit fielda 

1728 FB66 8D1A bar BfSCN ;cneck tonar bitfieWt 
1729 

1730 FB68 24 OB bcc ?tjmdn :rw timer for thia rule. 

1731 ;C unchanged with OECA in BFSCN 

1732 FB6A D£ 1A Idx Outadr jrecouer pointer to output vi 

1733 FBftC EC 01 Idd 1,x ;get rule 1 4 timer 

1 734 FB8E 2A 03 bpl ?»ettm ;po»dve rule forcexi tim 
1735 

1736 ,99 and*#*7F ;mask off high bit 

1737 FB70 DD1E std Inhrul ;neg rufe#, inhibit rimer 

1738 FB72 39 rta 

1739 FB73 ?s«nm: 

1740 FB73 DO 1C atd Frcrul ;save hers for timint 
1741 

1 742 ; Idas #T ;rjbg 

1743 ; jmpdbg ;t 
1744 

1 745 FB75 39 Ptimdn: rn .done for now 

1746 .page 



£5 
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1747 ; 

1 74S ; locomotor: lock motor in safe coition 
1749 

T750 ;loc motor: ;uaed by EEUDAT6 

•j 751 ; idaa MSAFE ;tjet positon from EE 

1752 ; felt into LD_MOTOR 

1753 .»»••• 

1754 ; LD_MOTOR. Scale motor value in MAM to 18 bit timer value Mtirrw 

1755 :•*"•* 

1756 FB76 LDJVIOTOR: 

1757 ; cmpa Latmot ;chack previous setting (Lest Motor Time) 

1758 ; beqldr ;skip computes if same (for speed) 

1759 FB76 .' 

^ 7fi0 ; staa latmot ;s*ve motor time tor next am* in 

1781 F876 40 tsta ;;«« CC» 

1762 FB77 27 03 beq zero ;no biss since i«ro requested 

1783 FB79 BB FS 04 adda MBIAS ;edd in biea from EE 

1764 

] 755 should be EE7 so dynamic waling possible 

1768 FB7C C8 14 zero: Ida* IMOEG ;degreoa -> time 

1767 FB7E 3D mul ;compute it 

1 768 FB7F DO 70 etd Mtim* ;and stuff here for output tnts 

1769 FBfll 39 Idr: rts 

1770 P«B« 



1771 
1772 
1773 
1774 
1775 
1776 
1777 
1778 
1779 
1780 
1781 
1782 
1783 
1784 
1785 
1786 
1787 
1788 
1789 
1790. 
1791 
1792 
1793 
1794 
1795 
1796 



; BFSCN. cheeks a bit field for a 1 at the rule $ in B 

; and returns Carry Set if high 

; X points to BF, uses Scnrul ferrule to check 



FS82 
FB82 
FB84 



; BFSCNB. 1 
; Alters A 
BFSCN: 



rule # being checked 



;rula being checked 



IdabO.x ;oetbits 

anda J»7 ,-mastc A to bit * In byte 

Isle .into carry 

dec* ;count down. C unaffected 

bge shib .-until done 8 times 



;retum with Carry set/dr from chosen bit 
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Idx #Rfo J»asa 




andb IJ7 


;mask to channel* only 


abx 


; off sat to channel t 


Idaa $8,x 


;8«t K1J =previoue 


Idab #4 
mul 


:4*f<1> 


5td Dtamp 


;3ave for later u«« 


idaa 410,x 


;f{0) 


Idab #3 




mul 


;3*f<0> 


subd Dtemp 


:3*«0i-4»R1> 


»td Dtomp 


,sova again 


Idab 40.x 


;f(2) 


dra 


;Wgh ordar dear 







1797 
1798 

1799 ;0 *a $10 »1fl 

1800 FB92 DERIVE: 

1 801 ; bar fclr ;dbg flag 
1802 

1803 FB92 37 pshb ;a 

1804 FB93 CE00 50 

1805 FB98 C4 07 

1806 FB98 3A 
1807 

1808 FB99 A6 08 

1809 FB9B C8 04 

1810 FB90 3D 

1811 FB9E 0D49 
1812 

1813 PBA0 A6 10 

1814 FBA2 C6 03 

1815 FBA4 3D 
1816 

1817 F8A5 93 49 

1818 FBA7 DO 49 
1S19 

1820 FBA9 E8 00 

1821 FBAB 4F 

1822 FBAC .03.49 
1823 

1 824 ;by way of explanation for tha following coda 

1825 ;DEC1 HEX 

182S ;385 0181 after ASR shift value* 

1827 ;129 0081 

1828 ; 128 0080 if rrwbyt* i« zero b«f ore shift than data will b« ok, ttitt pffmx 

1829 ;127 0G7F 

1830 ;001 0001 

1831 ;000 0000 

1832 ;-01 ffff 

1833 ;-127ffS1 
1S34 ;-128ffS0 

1 835 ;-1 29 ff7f if mabyt* ia FF bafora shift than data wiU ba ok, alsa nmax 

1836 ;-3aS fe7f 

1837 FBAE 40 Ut» ichack high ordar info 

1838 FBAF 27 06 beqTbok ;piut normal, exit ok 

1839 

1840 FB81 2B04 bmi 7ft«t ;cn«ck negative 

1841 

1842 FBB3 CS 7F Idab #127 ;po*tive limit 

1843 FB8S 20 OA bra Fadvt 
1844 

1845 FBB7 81 ff ?ft«t: cmpa *$FF ;othaf limit 

1846 FBB9 27 04 b«q ?bok ;nag normal, awt ok 
1847 

1848 FB86 C6 80 Idab #-128 ;nag limit 

1849 FBBD 20 02 bra ?»dvt :stora it 
1850 

1851 F8BJF 47 ?bok: asra ;/2 

1 852 FBCO 58 rorb ;tha long way «inc» no ASRD inatniotion 
1853 



1SS4 FBC1 E7 18 ?»dvt: stab 9 18.x 

1855 FBC3. 33 pufb 

1856 ; bsrfsot ;claar debug flag 

1857 FBC4 

1858 FBC4 39 rta 

1859 ;1 8 bytes* 
1860 

1861 -page 
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1866 : MAIN PROGRAM • 

1867 



.certain OPTION, INIT & TMSK2 Bit* can only b* written once! 
tggg ;up to 64 E cyda* after reeet, so we MUST configure 

1870 ;here immediately after power-up of COP reset. 

1871 START: ;onco only at power up 

1872 FBC5 CE10OO Idx #REG iragiiter ba*« 
la73 ; ld«#«01 ;R«m @ »0, Reg @ *1O0O 

1S74 ; ataa *103D ;INIT @ reset. But RESET put it thia way ANYWAY 

187S 

1876 FBC8 86 92 Ida* #i92 :for optoorta... 

,377 ;ADPU-1 -onCSEL-O-E IRQE-O-Lvl DLY - 1 -0 CMS -0 -Off X -0 CR - 11 -cop -.26 Sec 

1878 FBCA A7 39 ataa _0PT10N,X :make any change* now! 

1873 

1880 ; idea »*0O :Block Protect off for now 

1881 3tM 6P"0 T 

1882 FBCC 8F35 clr _BPROT,X 
1883 

1884 idea #*0O :omer baao rate .SuSae & 2Mhi, sfl int* off 

1885 ; staaTMSK2 ;sot rate nowl 

1886 FBCE 8F24 dr _TMStt.X 
1887 

1S88 ;Thi* rooily should be dona by EVM board since ■ change to CONFIG requtrea 

, as9 ;:hat ALL EEprom in -A1 be erased IBulk ie only way to eraae oonfig) 

1S90 " ;H.gh 4 bus determrn EEPROM locacon in -A2 chip (2k on uppaf T/2of 4k bound - ~ 

) 

1891 ; if! expanded, elae $F8O0 if singis chip mode. 

18 92 ; EE overtaya ROM in -A2 Single chip therefore no Buffalo routinaa access! 

1833 ld»ej***ED ; «e for EE in -A2. noeao-1 noeop-1 romon-0 aeon- V 

1394 ; staaCONRG ;sat configl But tinea EE cad don't hava to. 

1895 

1896 : ifdafllLBi 

1397 

1898 ; Idd *OCXX 

1899 FBDO 4F elm 

1900 FBOI 5F drto :the email way to gat D -0 

1901 FB02 DO 44 atd Mabb .prevent tjaafi fir« cm* around 

1902 FBD4 20 OC bra BEGIN .-skip thia next bit 
1903 

1 904 ; wa and up here on an illegal Instruction or SWI trap 

1905 FB06 30 ISTAflT: tax :gat old atack for illegal inatruction trap 

1906 FBD7 OF 44 stx Mabb ;sava for output later 

1907 FB09 ISCtOOAA Idy #IN_8UFSTA ideal 

1908 FBDO C6 10 Idab #1 6 ;thie many 

1909 FBDF BO FC 70 jar COPYM ;eopiad (iitart) & PRAY atack ia 0KI77 

1910 ; 

1911 ; 

1912 .normal restart of program (*Rt 

1913 : 

1914 FBE2 BEGIN: 

1915 FBE2 OF »ei ;n 

1916 FBE3 8E00FF Ida #TQS 
1917 
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FBE6 SD 40 
FBE8 0£ 



1923 
1924 
1925 



1928 
1929 
1930 
1931 
1932 



F8E9 CE F8 00 
F8EC C6 03 
FBEE SD FE as 



and other stuff yi 
; * sagnon 

Ux 1SIGN0N 
jsr PMSG 
.SIGNON tan is only ver- 
Idaa *VER 
jar HOUTS 



Idx #OAT£ 
Idab #3 

jsf PHMSC 



;initialile sub-»y»wmj 
H mask. !nt'j enabled globally 



;Ru)e data in EE 
;ihie many 



1940 
1941 
1942 



FBFA C6 10 
FBFC CE 00 AA 
FBFF SD FE 88 

FOOT" ■ - - 



idab #18 ;thia many out 

!dx #1N_BUFSTA .-from here) 

jsr PHMSG ;rniorm user 



andif 
• power on Mar 



1951 
1952 
1953 
1954 

1955 ;f 

1956 ;• 

1957 FC02 BD FE 60 
195$ FC05 12 41 OS F9 
1959 

1980 ; 

1961 FC09 BD Ff 21 
19S2 

1963 FCOC 25 F7 
1984 

1965 FCOE 13 40 40 09 
1986 

1967 PC12 8100 
13«a FC14 26 02 
1969 

1970 FCIfl 20 EA 
1971 

1972 FC18 B0FE3E 
1973 

1974 FC1S ne 



Idaa W .-starting cmd 
jsr OUT_QC :eeho 



jar Iprompi ,naw lina & rula # on screen 

br»« Ras2,CaQ,lpin .-Rule changed? print it 



boa Iptn ;Wait until w« hava ona 

brcir Flag 1 , EFL.G .neeho ;Eeho? none if cir 

empe /CR 
one echo 

bra Ipin :cr)f & prompt 
jar OUT_QC ;£ch» it 



SO 
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197S 
1976 
1977 
197S 



1983 
1934 
1985 



FC1S CE F9 00 

FC1£ BDF9 32 

FC21 25 02 

FC23 20 DO 

FC2S 86 21 

FC27 BO F£ 3t 

FC2A BDFE3E 



1989 FC31 20 CF 



?cmd*: idx #CMDTB(. 
jsfCWDDISP 
bcs ?«rr3 

bra Ipin ;Get n< 



;Uso ihi* tsblB 
;CoMmanO DISPatch 
.■Commend not found 



Idea # J t' ;Bad command response 
jsr OUT_QC ; Sand it 

jsr OUT_QC ;Twica 



;Has everything been printed? 
;Hang around until it i» 



bra Ipin £tart over 



1992 
1993 
1994 



SO 
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1997 
1998 
1999 
2000 
2001 
2002 
2003 
2004 
200 S 
2006 
2007 
2008 
2009 
2010 
2011 
2012 
2013 
2014 
2015 
2016 
2017 
2018 
2019 
2020 



FC3A 

FC3A 00 42 



(Oil 
[OOi 



2021 
2022 
2023 
; 2024 
202S 
2026 
2027 
2028 
2029 
2030 
2031 
2032 
2033 
2034 
2035 
2036 
2037 
203S 
2039 
2040 
2041 
2042 
2043 
2044 
2045 
2046 
2047 
2048 
2049 
2050 
205! 



FC48 4F 

FC49 5F 

FC4A 00 10 

FC4C OD 70 



FC5S 00 3D 
FC5A CE10 00 



WITS: 

;@@ oouid do this with a LOO. SCO if space gets tight 
Idaa *EFLG ;start with... 

,-no XOFFR, ECHO no HEX INPUT 

; staa Flagl ,-stuff it 

; Idaa #0 ;nothir.g hora for now 

staa Flag2 

idd #<lEFLG) -256+0) combined. Flagl '256 + Hag2 

:stuffed hero 



std Flagl 
std Flsg3 
Idd #Tmot 



;ru!e Rafla3 starts out CLEAR (F1ag4 tool 



;starup set, X will point tt 



Idst Jfilblk ;block to fill 

Idd #«0010 ;Fi!( block, length 

sta 0,x ;stuft fill value 



std Srcadr 
std Mtime 
Std Stime 



;the small way to get 0*»0 

;so no errors on startup 

;no stop time 
falsa beeper 



atd BtiftM ;r« 

maybe Currul - JFF barter? 
dacb 

std Curmod 

in is where the startup rule is fired 

Idd #10101 :forco rule 1 on 1st timint <##tt) 
std Frcrul ;by stuffing here 

Idd #40001 ;> no repeat, .2 beep on reset 



p.2* 



Idx IREG 
Idea #400 
Idaa #*FF 
staa ODRC 



;get base again (EEUOATE may corrupt) 
:sat ail bits as input 

;set all bits as output for now (no pullups) 

;Data DiR C 
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2052 
20S3 
Z054 
2055 
2056 
2057 
2058 
2059 
2060 
2061 
2062 
2063 
2064 
2085 
2066 
2067 
2068 
2069 
2070 
2071 
2072 
2073 
2074 
2075 
2076 
2077 
2078 
-2079 
2030 
2031 
20S2 



FC50 6F 07 



fCeO' A7 22 



FC6F 86 30 
FC71 A7 30 



2086 
2087 
2088 
2089 
2090 
2091 
2092 
2093 
2094 
2095 
2096 
2097 
2098 
2099 
2100 
2101 
2102 
2103 
2104 
21 OS 
2106 
2107 
2108 



FC73 CEF8 16 
FC76 18CE00 
FC7A F6 F8 OB 



FC70 A6 00 

FC7F 1 8 A7 00 

FC82 08 

FC83 18 08 

FC8S SA 

FC86 2E FS 

FC88 39 



;Foko a reed to clear SP1F fteg 



timer 0C1 

n't do this hare since we don't want a rattan to ba viaible, ah? 
1 int 32msec after power up?? 

IddTCNT ;eurr«ndy 

addd JRTCRAT ;»ome time from now 
, std T0C1 ; setup 

Ida* #480 ;OCl bit 

staa_OClM;X ;let 0C1 affect 0C1 bit 
staa _0C1D.X ;sat 0C1 high on comparaa. others low 
ortier " ataa _PACTt.X ;anabla output driver 0C1 
_'_ ...... .. .^twi^TM'SKljX ;«rietta.0C1 timer inta |»«0)- - 



; Start A/0 scanning/convening 

Idea #430. 
; ldaa#*10 :scanO-4 

staa _ADCTi.X ;start A/0 

.... cOPYRcopiaa MODEOO so ram 

COPYfl: Idx #MODE0O ;src here 
2 eopvbf: Idv fCurmbf rdaat he« 

idab BFCMT :bit fieM si 

;SeH into 

;COP\M. X point* to Src, Y to Oeat, 8 ia size. G 
COPYM; IdaaO.x :get data 



;SCIINI. InitialiM HOPTR, TUTR. BFSIZ , BAUD. SCCR'a 
;couid use copym but only one bvte saved 18L va 17M 



and maybe power down if slow enough) 
iCCF/x/acan/murt chO-4 :»c«n 6-4 repeatedly 
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2109 FC89 CC0OAA SCUNt: Idd #IN_8UFSTA ;init hdptre & tlptra to start of buffers 

:110 FC8C DDA6 std ln_hdptr 

2111 FC8E DDA3 std Injiptr 

2112 

2113 FC90 CC0O8O m #OUTJF5TA 

2114 FC93 DD AO std Out_hdptr 

2115 FC9S OD A2 std Outjiptr 
2116 

2H7 ; Idd #0000 ;buff«rs start out empty 

21 1 8 FC97 4F clra .-buffers start out amply 

2119 FC98 5F cirb ;the small way to gat 0 -0 

2120 FC99 DD A4 std Out_bffil ; which dears Injjffi! in following byts too 
2121 

2122 : tntastiKe SCt registers 

2123 FC98 CE10 0O Idx #REG .register basa 

2124 : Idaa #$00 ;1/8/1 bits. Wlo line wakes revr 

2125 swaSCCRI 

2126 FC9E 6F 2C dr_SCCR1,X ;sotup 
2127 

2129 ;EE byte for baud rata 

2129 ; ifndef CHIPA2 

2130 : W«sF803 ;from hern 

2131 ; else 

2132 FCAO 86F8 03 Idaa BORATE ; S 30 » E/1 3/1 > 9600 $34 =-E/1 3/18 > 600 baud 

2133 ; endtf 
2134 

213S" ;' stei BAUD < ■-■ - - -t • - 

2136 FCA3 A7 2S mm.BAUD.X 
2137 

2138 SCHEN: ;EEUDAT£/SAV6 returns here to restart Rxint's 

2139 FCA5 CE 10.00 Idx #REG ;base again because of ££ (6 va 8) 

2140 FCA8 1C2D2C beet _SCCR2,X,42C ;RcvrlrttE,TxEn,Rx£n 

2141 FCAB 39 rts 

2142 ; • * * * and of sciini 

2143 ' -page 
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2145 - £E UpDATEs only changed bytes sines faster than whole rewrite 

2146 ; Copies e piece of code to RAM at IN BUFSTA since EE disappears on EELAT 

2147 ;»••• 

2148 we now only update a small block at a time 

2149 ;svmsg: db "avin","g* + $80 
21 SO 

2151 ;*••• SAVE} udatea ££ 

2152 FCAC SAVE: 

2153 ; bsr EEUDATE .-called at command level now 

2154 ; braSCIIEN restart Bxints 

2155 FCAC EEUDATE: 

2159 ; Idx Sevmsg ' jinform ' 

2157 ; jsrPMSG ;ussr 

215S 

21 59 we should be so faet that no one noticee 10msec hick-up 

21 90 ; sei ;tum off ints 4 pray for no COP, X1RQ 

2161 



30 



45 



2162 






;@ strictly speaking RXint ONLY need* to be off at tl 


hie point. Later ALL < 


2163 


FCAC 


CE 10 2D 


Idx #SCCR2 


;regi«ter to rrw 


iss with 


2164 


FCAF 


ID 00 20 


bclr 0,x,*20 


;kill rxint enabi 


le {6 bytes) 


2165 












21 68 


FCB2 


CE FD 00 


Idx #pbe« 


;arc 




2167 


FC8S 


18 CEOO M 


\ Idy <tlN_ BUFSTA 


:det. since ust 


airy empty 


2163 
-2T69- 


FCB9 


C6 10 


Ideb #(pbeee-pbe«) ;lang 


rtftless than 256! H< 


2170 


FCB8 


80 FC 70 


jSf COPYM 


;copy EE subrt 


Httina to ram 


2171 










2172 


FCBE 


OE 10 


Idx Srcadr 


xurrant souro 


a in ram (EE write sd 


2173 






beqpbret .-nothing 


to save, AN ERROR 


2174 


FCCO 


8C F8 00 


' cpx *£E 


.-where EE sits 




2175 


FCC3 




Wopbret :not EE, 


skip itl 




2176 












2177 


FCC5 


18 CEOO 00 


, Idy JWrkrui 


.-rem table 




2173 


FCC9 


C6 10 


Idab fRSIZ 


,-is this big 




2179 


Fcca 


18 A6 00 


pcomp: tdaaO.y ;gat current ram data 




2180 


FCCE 


A1 00 


cmpa 0,x 


.compare with 


previous saved EE 


2181 


FCOO 


27 1E 


beqbdec 


;same so skip 


pgrrring this byte 


2182 










2183 


FCD2 


37 


pahb 


;save counter 




2184 


FCD3 


13 3C 


pahy 


,-save current i 


jointer 


2185 






;dbg... 






2186 


PCD5 


36 


pa ha 


;save data 




2187 


FCD6 


BOFE A3 


j»r H0UTC2 


:dbg 




2188 










2189 


FCD9 


32 


pglo 






2190- 


FCDA 


36 


pah* 


.save again 




2131 


pcoa 


BO FE AF 


jar HOUTS 


■dog 




2192 












2193 


FCDE 


32 




:get data back 




2194 






;...dbg 






2195 


FCOF 


C6 16 


Idab #416 


;byte erase fin 


»t 


2196 


FCE1 


3D 15 


bsr pbe 


;do it 




2197 










2198 


FCE3 


OE 


ell ,-allow an int (but no rxii 


it) since rules still in 


2199 


FCE4 


81 FF 


cmpa I »FF 


;did we only n 


«*d an erase? 


2200 


FCEfl 


27 04 


beq ffdone 


;yes 
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2201 
2202 
2203 
2204 
220S 
2206 
2207 
2208 
2209 
2210 
2211 
2212 
2213 
2214 
2215 
2216 
2217 
2218 
2219 
2220 
2221 
2222 
2223 
2224 
2225 
2226 
2227 
2223 
- 2229 
2230 
2231 
2232 
2233 
2234 
2235 
2236 
2237 
2238 
2239 
2240 
2241 
2242 
2243 
2244 
224S 
2246 
2247 
2248 
2249 
2250 
2251 



fcec oe 

FCED 1 a 38 

FCEF 33 

FCFO 08 

FCF1 1 S 08 

FCP3 5A 

FCF4 26 05 



ifdaf COPON 
:copset raaets the COP til 
copsot; Idas #555 

stab COPRST 



;COP needs attoniion 

to 1AA. one byra ahortef 



FCFO 76 00 AA 



FOOO 

FOOO F7 10 38 

F003 A7 00 

FDOS 7C 1 0 38 

FDOS 18 09 

FOOA 20 FC 

FDOC 7F 10 3B 

FOOF 39 
FD10 



Idy #2200 :2S0O 10 ms«@ 4ey/doy 3333 - 10m3«c@3/dex + 3/boa 

;stop ALL in» & pray no XIRQ 
w .-program byte/erase & rat 

jmp IN^BUFSTA ' ;iw raaily hora 



Slab PPROG 
stu 0,x rwrit 
inc PPROG 



:EEPGM up 
;ur»tit dono 



• end of EEUDATE 
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22S2 












2253 






j ENTER ; Fddlos t 


nemory location 


. Operates directly i' ADDR < SBOOO 


2254 






: ADJUST; Adjust 




bio. Asks for rule M. copies to rsm if not 


22S5 










aramster to change. 


2256 






;@ have fun... 






2257 












22S8 












22S9 






;rnmsg: db "dj ". 


•#■-530 




2260 


FQ10 


00 OA C5 


eimsg: 


db CRXF.-E- - 


S80 ;*E!em",-f* + JS0 


2261 






.nvmsg: db "Ne* 






2262 












2263 


FD13 




update: . 






2264 


FD.13. 


9C 10 




cpx Sreadr. , 


,-sarne as current request in X? 


2265 


FD1S 


27 00 ' 




boq ?ondud 


;yes. no RAM update retired 


2266 












2267 






:@ do wo wont to prompt for save? Do we want a reread? 


2268 






; ■ |Sf EEUDATE ;differont, need to update EE before overwrite 


2269 


FD17 










2270 


FD17 


OE 44 






recover requested source address 


227: 


FD19 


OF 10 




stx Sreadr 


;new set will be from here 


2272 


FD1B 


IB CE 00 00 


IdV #Wrkrul 


idoatination is.. 


2273 


F01F 


C6 10 




Ideto #RSiZ 




2274 


FD21 


80 FC 70 




isr COPYM 


;copv new set to ram 


2275 












2276 


FD24 


OE 10 


?endud: 


Idx Sreadr 


iflet it again (unfortunately) 


2277 


FD26 






atx Offadr 


;fix offset for print outs 


'227S- F028- 






(oVIWrlerul " 




2279 


FD2B 


OF 4B 




stx Adjadr .. 


;setup work pointer 


2280 


FD2D 


39 




rta 




2281 












2282 






ENTERj 


;u*es absolute 


address, no rule fiddling 


2283 


FD2E 




ENTER: 






2284 






; Idx fevmsg ;ente 


value message 


2285 






; bsr GETNUM ;inpu 


an address. Returns to main if nothing entered 


2286 


F02E 


30 67 




bsr GETVAL 


;got a value. Return to main if none. 


2287 












2288 


FD30 


CE01 10 




Idx #40110 


;hooder 1 line, 16 olomonts 


2289 


FD33 


BO FE 06 




jsr ENTDMP 


:do header 4 data @ Mabb 


2290 












2291 


FD36 


4F 


giro 


;zoro 




2292 


FD37 


SF 






>mall way to get 0=0 


2293 


FD38 


00 25 




atd Offadr 


.assume direct eddr. Clear offset 


2294 












2295 


FD3A 


0E44 




Idx Mabb 


;get the address to fiddle 


2296 


F03C 


3C 86 00 




cpx JSB600 


liowor limit of EE 


2297 


F03F 


25 2E 




bio fulodr 


;no EE udete, use it directly 


2298 












2299 


FD41 


80 00 




bsr update 


;update EE if different from current 


2300 
2301 


FD43 


20 2A 




bra iuladr 


:to common code 


2302 












2303 






:*••♦ ADJUST] 


widdte rules. fnendiier user interface 


2304 


FD4S 




ADJUST: 






2305 






: Idx #rnmsg ;ruie t mag 


2306 






; bsr GET 


NUM ;input rule t. Returns to main if nothing entered 


2307 


FD4S 


8D SO 




bar GETVAL 


.get a value. Return to main if none. 


2308 
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2309 FQ47 DS 45 

2310 FD49 37 

23 H F04A BO FA 3 A 

2312 

2313 

2314 

231 5 FD4D OF 44 

2316 FD4F 8D C2 
2317 

2318 FD51 33 

2319 FD52 SC 

2320 F0S3 BD FA 3A 
2321 

2322 
2323 

2324 FD56 8F 

2325 FDS7 93 10 
2326 

2327 
2328 



2329 
2330 
2331 
2332 
2333 
2334 
2335 
2336 
2337 
2338 
2339 
2340 
2341 
2342 
2343 
2344 
2345 
2346 
2347 
234S 
2349 
2350 
2351 
2352 
2353 
2354 
2355 
235S 
2357 



FD50 C6 10 
FD5F 86^1 

'fgai "IP — 

F062 80 FE C8 



F06A OE 43 

F06C 08 45 

FD6E 3A 

F06F 3D 12 



F073 

FD73 80 FF 3D 

F076 25 28 

F078 4F 

FD79 5F 

FD7A DO 25 



2361 FD7C 0E44 

2362 FD7E 20 03 
2363 

2364 FDSO 



Idab Lsbb ;gat rule * into 3 

pshb ;save for 2nd ail* diffaroncs 

isr GETEDfl ;g<jt rule's address from indexed table (s 

; rjci ?«rul :alraadv in RAM 

stx Adjadr ;sava it here for later use 

six Msbb scuff for memdmp to use 

bsr update ,-update EE if needed 

?nrul: pulb jrecovet rule # 

incb :ne« rule * 

jsr GETEDfl ;o.et next rules's address 

:bcs not needed here since if rule w«* in rem, this one wouldn't be 

;and if it wasn't, rule would have been put there by update 



. Do we set the NEXT one up & 

io w; just limit to 1 6 elements, 
andb #SOF ;and 8 hat length {1 6 max) 

bne ?bni .-reasonable length? 



le line of info, b has length 
it memdump do the work 



Idd Adjodr ;recover basic address . 

addd Msbb . ;indude element offset <16bil) 

ve can't be more than 1 6 elements offset 

tdx Adjadr .-get basic address in RAMI! 

Idab Lsbb ;indude element offset 

abx .include in X 

fuladr: bsr prnadr ;toll them 

bra tadj ;tune it 

•H use* theae. X preset to Adjadr by CMDSPH 



std Offedr 
Idx Msbb 



a small wey to get 0 »0 



;get input value 
;stuft & print 
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2365 FD80 08 

2366 FOB! OS 

2367 FD82 
236S FD32 
2369 F082 09 
2370 

2371 
2372 
2373 
2374 
237S 
2376 
2377 

2378 F0S3 OF 4B 

2379 FD85 3C 
2330 FD86 SF 
2381 FD87 03 25 
2332 FD89 SF 
2383 

. 2384 FD8A BD FE A3 
2385 

2386 FD80 38 

2387 FD8E 3D F£ A2 
2388 

2389 F091 7£ FF OC 

2390 

2391 

- 2392 ~ 

2393 
2394 
2395 

: 2396 F094 BDFE 71 
2397 

2398 F097 BD FF 3D 

2399 

2400 

2401 FD9A 24 01 
2402 

.2403 FD9C 38 

2404 FD90 
■ 2405 

2406 

2407 

2408 F090 OC 

2409 F096 39 
2410 

2411 
2412 
2413 
2414 
2415 

2416 FD9F 
2417 
2418 
2419 

2420 FD9F 14 41 01 



anab *$f 
*gdx 



.-modify pointer 



;swap to D for limits 
. ,-high order of address <256 (RAM <s> 0) 
rmodulo 16. A will be wo 
;oacK to X 



X Adjadr 



'4 tor RTOSPH functions 
pahx .save Ram address 

;swap into 0 

addd Offadr :equival«nt address offset (since data's 

;0ack to X 

lsrHOUTC2 :primit 



jsrCRLF ;new line & 

jmp svp :prompt for adjustments 



-;GETNUM;-prornpts with message-@-X-4~a«»-a i i 



;GETVAL As above but no message. 
; placed hare so BSH's in possible . , 

CETMUM: jsr PMSG 



>r with- echo, Returns to n- 



bcc ?getpfc 
pulx 



,o error, normal ratum 

iop caflera address. Roturning to MAIN 



;tnmsg: db "una*." * * S80 
TUNE: 

; tdx ftnmsg 

; jar PMSG ;tune mag 



□sat Flag2,TFLG ;stop state diagram, sat tuning flag 
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2421 
2422 
2423 
2424 
2425 
2426 
2427 
2428 
2429 
2430 
2431 
2432 
2433 
2434 
2435 
2436 
2437 
2438 
2439 
2440 
2441 
2442 
2443 
2444 
2445 
2446 

2448 
2449 
2450 
2451 
2452 
2453 
2454 

2455 : 

2456 ; 
245? 



Idx *Ad[adi 
Idea 0.x ;get vaiue 
staa Tmot 



setup as return for RTOSPH if ESC entered 
:lsst Mdrsss adjusted 



FDAB 4F 
FOAC SF 
FOAO OD 2S 



FDAF 80 FE A2 
FDB2 80 FF 21 
FDB5 25 FB 



address to fiddle 
.setup for keyboard 



;the smafl way to got D»0 
:Zaro offset for correct print out 



;ontry here from enter and adjust 
tedj: jsr CALF ;new I 



F08C 13 41 01 F2 
FDCO 96 40 



jsr RTDSPH ;adjust a variable 

bcs ?sip ;not one of ours so loop again 

brclr Ffag2.TFi.G.?slo :n«t tuning motor, i 

Idaa Tmot ;from new temporary value 

— jsr UG : MOTQR- --scsf e-to-Mtima 

bra ?slp ;and hang around until ESC causes esdt 
entered by ascexit's attempt to return to main 
bclr Flag2,TFLG ;reonabl« s 



; adjust's abort e: 



rts 



:return to main 
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2458 
2439 
2460 



: Serial communication interrupt rt 



2463 
2464 
246S 
2466 
2467 
2468 
2469 
2470 
2471 
2472 
2473 
2474 
2475 
2476 
2477 
2478 
2479 
2480 
2481 
2482 
2483 
- 2 484~ 
248S 
2486 
2487 
2488 
2489 
2490 
2491 
2492 
2493 
2494 
2495 
2496 
2497 
2498 
2499 
2500 
2S01 
2502 
2503 
2504 
2505 
2506 
2507 
2508 
2509 
2510 
2S11 
2512 
2513 



0 sped up. @96008 loss thon 1 msec/char available, +• other in 



FOCE A6 2E 
FODO 8S 20 
FDD 2 27 36 



FDF4 22 14 



FDF6 3C 

FDF7 OE A6 

FDF9 A7 00 

FQF B 7C 00 A5 



Idx #R£G 
a SCSR ;wh< 
Idoo SCSR.x 
bits #S20 



a SCDR :IS r 

Idas _SCOR.x 
anda">i7f 



;wlw interrupted? 
:Tx/Te/Rdrf/ldl 0r/Nf,'F«/X 
;is NOT the raoaivof, mayba a 

iver, so get character 

: clear parity 



FOES-IS ~40 80 
FDE8 

FDE8 96 A4 
FDEA 27 3 F 

FDEC 80 41 

FDEE 20 1 A 



bclrFlaglvXFRFUG-XONrlat tXiflP - 

Idaa Out_bffil ;stuff avail? (Ida shorter than tst) 
baq andint ;no. so (ini, nothing to TX now tha- 

bar won ;starrup a inis 

bra trantst .and process pending int 



is a TRAP. Can't get characters out sine* wa'r* hung * 
n ISRII! 

wtjn: Idab In_bff3 ;gat current sue 

cmpb #!N_BFMAX ;check for room 



bhi trantst .we'll just have to loose char while « 

;; could load bfmax into b and loop on cmp bltil for tighter loop 
:@could also allow 2 chars mare into buffer until xoff takes affect 



pshx :sava reg point 

Idx ln_ndptf ;get head poini 
staaO.X .'and store char in qua 



;ona mora in quaua, safe from Int's 
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2515 




n - „p 






mar ahead 




FDFF 






cpx *IN_BFEND 


.past and? 


251 7 








bis m^norapl 


;na, no wrap needed 


251 3 


F~04 


A 






yes. wrap back to th© start of buffer 


2519 


















. 

m_norap . 






_ 


FE07 


OF A6 




sxx !n_hdptr 


;update hdptr 


2522 


r^09 


38 






reo. pointer 


2523 


















fall hro 






2525 
























2527 






•mint sarvic d har 


s after rx does work (also rx bra's if XON/XOFR 


2528 












2529 


FEOA 




ran s . 






2530 


FEOA 






ldaa_SCSR.X 


;is it the transmitter? 




EOC 


2A !0 




bp) endint 


;no, so we'ra dona poll (TXSE = MSB, high is nag) 






















brset Flog 1 .XFRFLG.notrah ;Xoff? Yes, turn off txint for now 














2535 




96 A4 




Idaa Out_bffi1 


,is there anything left to transmit? 


2536 


FE14 


27 ID 




boq notran 


.empty, so skip to end & kill future ints 






















Idx Out_tlptf 


:get pointer 




FE18 


A6 00 




Idaa 0.x ;ael cha 




■^540 


"f'e'i A 


i"7~"lO _ 2F"" 


- 


staa SCOR 


;send it out 


2541 


FE1D 










2542 




08 




rrix 


.skip to next spot 


2543 


FE1E 


8C CO 9F 




cpx #OUT_BFEND 


:did we fall off end of buffer? 


2544 


FE21 


23 03 




bis out_nowrp2 


;no, skip wrap 


2545 














F£23 


CE OO 80 




Idx *OUT_BFSTA 


;yes, point back to the start 


2547 










254S 


FE26 




out_nowrp2: 






2549 


FE26 


OF A2 




stx Outjlptr 


:update tail pointer 






7A 00 A4 




dec Out" bffil 


;one less occupied space 


2551 








2552 






:; cmpa #0UT BFMIN ;should 


we send XON character? 


2S53 






;; bKi out_r 


xon ;no 


2554 












2555 






;:Ssnd XON. spec 


a available 




2556 






;;out_nxon: 






2557 












2558 


FE2B 


38 


endint; rtj 






2SS9 












2560 








nt for Xon, and OUT QC :> A must ba preserved 


2561 


FE2C 


CE 10 00 


txonx: 


Idx *REG 


;for out qc ■ 


2562 


FE2F 


1C 2D 80 


txon: 


bsat SCCR2.x,SSQ :set Tx tnt En if not already up 


2563 












2564 


FS32 


39 


rta 






2565 












2S66 






notran; ;@ bdr?7 .entered by fxint XOfF 


2567 






Idaa SCCR2 :got current flogs 


2568 






; and* *37f -aisabie 


ransnut interrupts 


2569 






staa SCCR2 ;bv lowering enable 


2570 
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2571 ; 

2572 FE33 ID 2D 80 
2573 

2574 XRET: ;xif<a ni 

2575 FE36 38 ni :alf dona horn 
2576 

2577 ...... h9fs for bsf limits 

2578 FE37 OD OA 20 20 20 spcmsg: db CR.LF." ".""*■ iSQ ;bianks for momdmp 
FE3C 20 AO 

2579 ...... 

2580 : Queue th« character in acca - > output buffer 

2581 : Returns A unchanged 

2582 change to 8 bit offsets from x to improve spa«d/s«e sine* only 256 RAM 

2583 ;;: use Bmoit '. 

2584 .Preserves B & X & A 

2585 ...... 

2586 FE3E OUTQC: 

2587 FE3E 37 pshb 

2588 FE3F 3C pshx 
2589 

2590 FE40 D6 A4 wt_out: Sdab Outjlffil :get currant sua 

2591 

2592 should probably bo a ram iocanon 

2593 FE42 CI 1F cmpb #0<JT_BFMAX .cheek for room 

2594 FE44 22 FA bhi wt_out : we'll have to wait for room 

2595 or load oc with max and loop on compare bffil for tighter loop 
_ -253.6 . -perhaps sat carry and raturn instead of looping 

2597: ■ . "" •• ' . -■' • " 

2598 FE46 DE AO 

2599 ■ FE48 A7 00 
2600 

2601 FE4A 7C0OA4 inc Outjlffil ;orw mora in queue ;lnt'» can't affect inca 

2602 

2603 FE4D 08 inx ;st«p pointer ahead 

2604 

2605 FE4E 8C 00 9F 

2606 F£51 23 03 
2607 

2608 FES3 C£ 00 80 Idx #0UT_8FSTA .yea, wrap back to the start of buffer 

2609 

2610 FE56 out norepl: 

2611 FEES DF AO six Ouijxiptr ;updata ndptt 
2612 

2613 FE58 80 02 bsr txonx .start up inta now that X can bo mangiod 

2614 

2615 FES A 38 pulx ;gat it ail back 

2816 FS5B 33 pulb 

2617 FE5C OC cic ;pravent arrara 

2618 

2619 FE50 39 rta ;of OUT_QC 

2620 -page 
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5 



10 



15 



20 



25 



35 



2621 






2622 






2623 






2624 






262S 






2626 






2627 






2623 






2629 






2630 






2631 






2632 






2633 






2634 






2635 






2638 


FESE 




2637 






2638 


FE5E 


38 


2639 






2640 


FE5F 


39 


2641 






2642 






2643 






2644 


FE60 




264S 


FE60 


80 40 


2646 






2647 


FE62 


96 18 


2648 


FE64 


80 59 


2649 






2650 


FE66 


96 19 


2651 


FE68 


80 45 


2652 






2653 


FE6A 


1 5 41 08 


2654 






2655 


FE6D 


86 2A 


2656 


FE6F 


20 CD 


26S7 






2658 






26S9 






2660 






2661 






2662 






2663 






2664 


FE71 




2665 






2666 






2667 






2668 


FE71 


A6 00 


2663 


FE73 


27 09 


2670 






2371 


FE75 


84 7F 


2672 


FE77 


90 C5 


2673 






2674 


FE79 


60 00 


2675 


FE7B 


OS 


2676 


FE7C 


2A F3 


2877 


FE7E 





;FREMO0: bcir FIag2,MFLG ;c[ear mode lockad flea 

; idx #?frmsg ;ard inform 

bra mand ;common and 

;?fmi30: db "re'Ve" +$80 
;)cmsg: db "oekoVd" + 380 

;LOCMOD: bset Rag2,MFLG ;set moda locked flag 

Idx *icmsg 
;mend: .fait into PMSG 
; bra PMSG 

; • • • ■ some of tha commands called from RTTBL 
; Esc axil. CMDDISP jumps to hero if ESC entered 
ESCEXIT: 

pu!x ;pop RTDSPH return (2 not used if BRA emdsph) 

puix ;pop caller return (Tuna, Dump, etc) 

rtend: rta ;should land u3 in main 



:c!ear current ruia needs prim flag 



tO A A # PROMPT ;Prompt character 
bra OUT_QC -Stuff in que & return 



;PMSG. print string @ X. null or hi-bit terminated 
:9SRa OUT.QC 

PMSG: 

;; tpa njet CC 

;; pane ;sav«. others may need C bit info 

tdaa 0,x ;get char 

baq ?pmd ;zero is end 

anda #S7F ;clear high bit to got rid of funny IBM chars 

bsr OUT_QC ;print it (PMSG) 

tst 0,x ;ch«ck for and, MSB high 

inx ;point to next byw 

bp! PMSG ;mara.fMSB»0 

?pmd: 



62 



EP 0 549 855 A2 









c lc ;stop possible errors ttst ctaaroti C) 


2679 








2680 














:i ' T restore CC* 


2682 






;@CC save/restore currency bombs. WHY? 


2683 








2684 


FE7E 


39 


rts rail dona 


2685 
7686 






CR than CNTRO 


2687 






•CRCNTR: bar CRLF ;newlina 


2688 






;*** * counts up # of vaiuee in B, printing a* it goes 


2689 












;CNTRO: clra ;atart @ taro 


2691 








3693 






;; pshx ;save 


2693 


FE7F 


37 


cntri: P3hl> 


2694 


FE80 






2695 






; pshe ;s8va 








bar HOUTS ."print it 


2697 








2698 






; dacb ;count down 


2699 






; bitb #7 ;moduto 7 


2700 






bno ?nspc2 ;no spaca yat 


2701 








2702 






bsr OUTS ;cmr spc out 


- "2703" 






;7nspc2: pula -recover 


2705 






inca :next valua 


2706 








2707 






tstb ;flags 


2708 






; bna cntri ;not yet 


2709 






■ 5 bytes saved. (lookod like 10 but bsr/rta/pshx/pulx ate 5) 


2710 


FE80 


8D OF 


bar phbc :subr to print, coumb etc. saves a I 


271 1 








2712 


FE82 


26 FC 


bno cntri ;B not zero, more to do 


2713 








2714 


FE84 


33 


pulb .-recover 


2715 






;; pulx ;;too ■ 


2716 


FESS 


39 


rts 


2717 








2718 






..... 

;PHMSG. print hex string @ X, space separated, B hos length 


2719 






2720 






;BSRa HOUTS 


2721 






;StvM a 


27 22 








2723 


FE86 


SO 1A 


PHMSGC: bsrCRLF ;new iina 


2724 


FE88 


37 


PHMSG: pahb ;savs it 


2725 


FE89 


Afl 00 


?phmsg; idea 0,x ;gei vaiue 


2726 


FESS 


80 04 


bsr phbc ;caH print aubr 


2727 








2728 


FESD 


26 FA 


bne ?phmsg ;not done yat 


2729 








2730 


FE8F 


33 


pulb yecover 


2731 


FE90 


39 


rts ;raturn 


2732 








2733 






; * *subr tor CNTR & PHMSG 


2734 


FE91 


36 


phbc; puna ;save for other caller (entrt 
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273S 


FE92 


80 1B 


2736 






2737 


FE94 


08 


2733 


FE95 


5A 


2739 






2740 


FE96 


CS 03 


2741 


FE9S 


26 02 


2742 






2743 


FE9A 


3D 15 


2744 






2745 


FE9C 


32 


2746 


FE9D 


4C 


2747 






2748 


FE9E 


5D 


2749 


FE9F 


39 


2750 






2751 






2752 






2753 






2754 






2755 


FEAO 


8D 00 


2756 






2757 


FEA2 


3D 71 


2758 






2759 


FEA4 


86 OA 


2760 


. F fA6_ 


20 06 


2761 






2762 






2763 






2764 






276S 






2766 


FEA8 


80 F8 


2767 


FEAA 




2768 


FEAA 


3C 


2769 


FEAS 


32 


2770 


FEAC 


3D 07 


2771 






2772 


FEAE 


32 


2773 






2774 






2775 






2776 






2777 






2778 






2779 






2780 






2781 


FEAF 






FEAF 


80 04 


2783 






2784 


FEB1 


86 20 


2785 






2786 


FEB3 


20 F1 


2787 






2788 






2789 






2790 
2791 







bsr HOUTS ;hex out with space (PHM) 

inx :next up (or wasted cycles if cnir) 

dacb :coun[ down 

: bitb #S7 ;modulo 7 

bitb #93 ;rnodulo 4 

bna ?nospc ;no addition space output 

bsr OUTS ;<tdd an extra o«e 

?nospc: pulo recover, tha other caller (cntr) needs this 

tstb ;set flag* 

rts rreturn with CCs sat 

CRLF sand3 out cr & If 
rLeaves A as LF 

CRR CR only 
:*•♦* HOUTSC. HOUTS + CRLF 

HOUTSC: bsr HOUTS rprint it firei 

:fall into 

CRLF: bsr CRR ;CR first 

idea #LF :LF next 

_ _outa: bra OUT_QC ;stuff & return (also used by HOUT.. exits) 

; H0UT2S. Hex OUT 2 Space from X value 
; A returns as SPC. X. 8 unchanged 
; SSRs: HOUT, HOUTS 

H0UTC2: bsr CRLF ;nawltiw 

H0UT2S: 




bsr HOUT .print it (H02S) 

puis ;gat low order byte 

bsr HOUTS ;print it with spaca 

;f all into 

; Hex OUT Space. Hex out with spaca 
; A returned ss space, B Si X ok 
; JSRa: OUT OC 
; BSRs: HOUT 

HOUTS: 

bsr HOUT .print it 

OUTS: Idea #SPC followed by.. 

; br« OUT_QC ;which returns 

bra cuts ;which returns 



: Hex OUT. converts the byte in A to hex and outputs 

; Cails: OUT_QC. 

; Oastroys A. B St X ok 
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2792 












2793 


FEBS 


36 


KQUT: psha 


.-save st 




2794 


FEB6 


80 03 




bsr ?outlh 


;sonc !oit half 


2735 












2796 


FEBS 


32 


puis 


;reeovar 




2797 


FEBS 


20 04 




bra OUTRH 


;send right half and lot IT return 


2798 












2799 


FEBS 


44 


?outJh: Isra 


;get high nybble first 


2S00 


FEBC 


44 




Isra 




2801 


FEBD 


44 




Isra 




2302 


FS3E 


44 


isra 






2803 












2804 


FsBF 


84 OF 


OUTRH: 


anda #«0f 


;mask out high nybbia 


280S. 


FECI 


8B 30 




adda #*30 


;convart to numeric 


2806 


FEC3 


81 39 




cmpa #939 


;in 0-9 range? 


2807 


FEC5 


2F OF 




bta oum ;yes 




2S08 












2809 


FEC7 


8B07 




adda #$07 


;bias to A-F 


2810 


F6C9 


20 OS 




bra outa ;aond 4 1 


eturn (hout) 


2811 












2812 












2813 












2814 






; MEMDMP! dump* 2S6 Memory values at address given 


2815 






; Bsr'a to HOUT 4 HOUTS 4 H0UTC2 4 


2816 






; ENTDMP use* M 


sbo for address. lowX for width, hiX for lina count. 


2S17 












281 a 






;llth equ16 


;!ina length memdmp 


2819 


FECB 


4F 


ADJDMP: 


dra 


;start headar at zero always 


2820 


FECC 


20 OA 




bra mamin 




2821 












2822 


FECE 


BO FF 3D 


MEMDMP: jsr HEX_B1Q :g*t start value ;@@ 1 


2823 


FED1 


2S 23 . 




bca mend 


;no entry so quit. 


2824 












2825 


FED3 


Cg 10 10 




tdx#»1010 


;1 6 lines, 16 dements 


2826 












2827 


FEDB 


96 45 


ENTDMP: Idea Ubb ,-stait header count here 


2828 


FED8 


97 48 


mamin: 


staa Acnt 


;stuff for tater use 


2829 


FEDA 


OF 46 




stx Lent ;sat lino 


count 4 length from X 


2S30 












2831 


fEOC 


CE FE 37 




Idx #spcmsg 


rfirat part 


2832 


FEDF 


80 90 




bar PMSG 


;of header (MOMP) 


2833 












2834 


FEE1 


96 48 




Idaa Acnt 


;get starting count 


2835 


FEE3 


D6 47 




Idab Uth ;4 Una langth 


2836 


FEES 


80 98 




bar CNTR 


;tha rest of the header 


2837 












2838 


FEE7 


06 46 




Idab Unt 


;# of lines to dump 


2839 


FEES 


DE 44 




tdx Mabb 


jload fetch pointer 


2840 














FEEB 


80 B8 


?mlp: 


DSrH0UTC2 


;print CR, X 4 space 


2842 












2843 


FEED 


37 


pshb 


;;save li 


ne counter 


2844 












2845 


FEEE 


06 47 




Idab Uth ;;thia m 


any out 


2846 


FEW 


80 96 




bar PHMSG 


;;ot this String 


2847 












2848 


FEF2 


33 


pull) 


;;recove 


it line counter 
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2S43 FEF3 5A 
28 SO FEF4 26 FS 
2351 

2652 FEF6 39 mend: rts ;until dona r of iines 

2853 

2854 ...... tNODEC var addresses 

2855 :X sat by RTDSPH to Adjadr 

2856 FEF7 INCVAR: 

2857 FEF7 6C 00 inc 0.x ;bump up value 

2858 F£F9 20 1 1 bra svp 
2859 

2860 FEfS DEC VAR: 

2861 FEFB 6A 00 dac 0.x 

2862 FEFD 20 00 bra avp 
2863 

2864 FEFF SETVAR: 

2865 FEFF BD FF 3D jar HEX_B)Q ;g«t a vatua 

2866 FF02 25 F2 bcs mend ;no input, usa old value (RTS) 
2667 

2868 FF04 D6 45 Idab Ubb ;fowar order of value input 

2869 FF06 OE 4B Jdx Adjadr recover value's address 

2870 FF08 E7 00 stab 0.x ;change value 
2871 

2872 ; bar CRLF ;ovorwrita old screen data 

2873 FFOA 80 09 bsr CRR ;ov«rwrit« old screen data 
2874 . _„_,_„ _ 

2875 flFOC leOO" svp: Ida* 0.x ;r»«iw new vah» 

2876 FFOE 86 7C idaa r|' .delimiter 

2877 ; 

. 2878 ; print character in A & value in S with trailing apace 

2879 FF10 PCHARV: 

2880 FF10 8D0S bsr outc ;bsr OUT QC ;print tho char (pev) 

2881 ■ ~ 

2882 FF1 2 17 tt>a ;got value 

2383 .' bra HOUTS ;dump out and return 

2884 FF13 3D 9A bar HOUTS ;dump out 

2885 

2886 ; bra CRR ;cr only 4 return 

2887 ;f a || into 
2888 

2889 FF15 86 00 CRR: Idea #CR ;CFt onfy 

2890 FF17 7EFE3E outc: imp OUT OC .-stuff & ratum (CRRI 
2891 

2892 ;*** end of PCHARV & CRR 

2893 

2894 ; 

2835 : FHULS | print* formated rules to screen (eventually) using adjust subs 

2896 ; Redundant! 

2S97 ;PRULS: ; d bg 

2898 : IdxMOllO .header 1 line. 16 elements 

2899 : jar ENTDMP ;do header fit data <§> Mabb 
2900 

2901 ; Wx Adjadr 

2902 ; bsr H0UTC2 
2903 

2904 ; | dx Mabb 

2905 ; bra H0UTC2 



2906 
2907 
2908 



EP 0 549 855 A2 



2909 



TO 



75 



25 



2910 






: JN OQ. DeQueue an input character into A 


2911 






; IN EDO. Echoed DeQueue 


2912 














; Alters A coda ? 


291 








2915 






' . us' ■ h acs IN DO. 
;C use m_dqw or those cal ors ooping. wit o _ 


2916 








2917 




so os 


iN _ • sr 1 _ -9 0< a 5 af 


2 q!q 
2919 


rFIC 


25 08 


. • t t ho so and ss o C 
rue ,no mpu ok , pa i g 


2920 








2921 






now 


2922 




• 


- OUT Qc" ° f 'echo it & return 
imp _ ,ac o i re 
















"IN OQW: bar IN OG ;cail it 


5955 






bcs IN DQW ;hsng around 


2926 














ft* 


2929 








J: 






IN DO/ 






96 AS 


Idea In bffil ;got size (TST larger) 


2 Ml 




■ 


bne m_cont .hove data? 










oil 


pp-c; 


on 


sec . aa carry ra m aa iero 


„ — 


— — - 




_ n ili 3? , _ , . . — . 






-— 




2936 


FF27 




in_cont. 










2938 




D£ AS 


P9hX Idx In tl tr S0VS " n0V et ointer 






■ 


Idab 0 • et char ' 


2940 


FF2A 


A6 00 


Idea 0 x -got char 


2941 


FF2C 














2943 


FF2D 


SC 00 fiF 


cpx #IN_BFEND ;did wa fall off end of buffer? 








bis ?in nowrp2 :no, skip wrap 


2945 








2946 


FF32 


CE 00 AA 

- 


Idx (IN BUFSTA ,yes, point back to the start 


2947 


FF35 






2948 


FF35 


OF A3 


act In tiptr ;updats tail pointer 


2949 


FF37 




dec In bffil ;one las* occupied. Int/s can't split this instruction 


2950 






;; should idea bfmin and compare directly? 


2952 






Idea In bffil 


2953 






; cmpa >IN_8FMIN ;should we send XON character? 








; bp! in nxon ;no 


2955 








2956 






...... y 4s Mnd X ON. space available 


2957 






thia needs development. How do you jam into output stream? Use Rags? 


2953 








2959 






ttoa .-copy to a 


2960 


FF3A 


OC 


etc .no error flag 


2961 


FF38 


38 


pubt .'recover rag 


2962 


FF3C 


39 


rt« ;we'radone 


2963 








2964 









50 
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2965 






HEX BIN. Convert Aseit hex value 


2966 






DECJ 


IN. Convert the characters in buffer to decimal and save in 


2967 








at non*numoric char 


which gets returned in upper ooae. 


2968 






Carry sot if no data to do 




2969 
2970 






Mangl 


as A.B, X 














2971 






@@@ Should NOT convert char to upper case?? 


2972 


FF3D 


86 3F 




HEX_BIQ:ldaa #'?' .-prompt... 


2973 


FF3F 


BD FE 3E 




jsr OUT QC ;for input (hexbiq) 


2974 












297S 


FF42 


HEX Bl 


M: 




2978 








bsot Bagl.HaO 


;sat hex bit 


2977 








bra?ddd . 


;skip pest decimal 


2978 












2979 




;0EC BIN: 




2980 








bdr Flagl.HFLG 


;dr hex bit 


2981 












2982 




mB y want a form thi 


t skips clear? 


2983 


FF42 


4F 7cldd: 


elra 


;clear value 


2984 


FF43 


5F 




ctrb 


;tha smaller wav 


2985 


FF44 


00 44 




std Mabb 


:hor«, gets Lsbb too 


2986 








bclr Flagl.NFLG 


;start out positive 


2987 












2988 


FF46 


30 18 




bsr rrjchk 


;get char & range check 


2989 












2990 


FF48 


25 34 




bos cane] 


:;out of bounds, return error, 


-299T" 












2992 


FF4A 


20 04 




bra ?a2 


;;ok, lets go with 1st time in 


2993 








bcc ?a2 


;a valid 1 st char . 


2994 
2995 








cmpa 
boq ?snofl 


.-negative sign? 
;sat nagarjvo 


2996 












2997 










.'plus 


2998 








bn« eend 


.'invalid 1 st char 


2999 








bclr Flagl.NFLG 


,-dr negative flag 


3000 








bra ?a1 




3001 






baat Flagl.NFLG 


,-set negative flag 


3002 










;fall into additional chars loop 


3003 


FF4C 


80 12 




?«1: bsrrgchk 


;gat char & chack limits 


3004 












3005 


FF4E 


25 24 




bcs aand 


;not vaSd, wa're dona 


3006 








bca anand 


.not valid, wa'rs dona 


3007 
3008 
3009 


FF50 
FF50 
FF52 


80 30 
16 




?a2: subs #'0 
tab 


;0K so far, strip down ascit 
;place in low half 


3010 


FF53 


8F 




xgdx 


;;swap to x 


3011 












3012 


FF54 


DC 44 




tdd Msbfa 


;gat old valuo 


3013 


FF53 


05 




asM 


; *2 






05 




add 


; *2-4 


301 S 








brdf Flagl.HFLG.ddoc ;hex way? 


3016 












3017 


FF58 


05 




asld 


;yes, *2=»S 


3018 








bra ?dh«x 


;do hex 


3019 












3020 




;?ddac: 


addd M»bb 


; +1 -5 


3021 




;?dhax: 
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3022 
3023 
3024 
3025 
302$ 
3027 
302S 
3023 
3030 
3031 
3032 
3033 
3034 
3035 
3036 
3037 
3038 
3039 
3040 
3041 
3042 
3043 
3044 
304S 
304fi 



FF5A 8F 

FF5B 3A 

FF5C OF 44 

FF5E 20 EC 



FF72 80 07 



; '2=X10orXl6 
;;swap back 



;Range check subf.Got character and check for numeric (or hex) 
rgchk: bsr IN_EDQ. ;u« char with echo 

DCS rgchk ;norse ovoil, wait 



cmpa #"' ;lowar case? 

bit ? rgck ;no, less than IsiL.C. char 



suba M20 ;chango to upper caso 

brcir.F1eg1,HFL.G.dchk ;Hex accepted? Bra if n< 



cmpa I'F' 

bgt cartd ;too big to ba used 



304S 

3049 FF74 OC 

3050 FF75 39 
3051 

3052 
30S3 
3054 
3055 
3056 
3057 
305S 

3059 FF76 81 30 

3060 FF78 2D 04 
3061 

3062 FF7A 8139 
3063 

3064 FF7C 2F F6 
3065 

3066 FF7E 00 

3067 FF7F 39 
3068 

3069 
3070 
3071 
3072 

3073 FFSO 

3074 FF80 BDFE60 
3075 

3076 FF83 C6 07 

3077 FF8S BDFB92 
3078 



;shift it to 10-15 



;return no arror coda & next char in upper case 
;we'ra dona. Return to caller 



;anend: brclr Flagl.NFLG.aond ;not negative, do normal exit 
; Idd Mabb ajat reauit 



addd #1 ;two's compliment negation 

bra aend ;e)aon exit 

dchk: cmpa #'0' in range? 

bit cend ;too smalt 



cmpa #*9' ' 
bgt cend ;too big, »at carry 
bleaend ;ok ending 



;ratum error coda & next chat in UC 



; 0UMP1 print the state, CH 0-7 4i Oigin 
DUMP: 



jsr (prompt ;fresh line &. prompt with Currui & *' 

starting here 

; compute the derivative data 



Idab #7 
?<Jvs: jar DERIVE 
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3079 


FF8S 


5A 


dscb ;count down 


3080 


FF83 


2C FA 


bge ?dvs ;umil dona all 


3081 
3082 


FF8B 


CE 00 60 


idx #Anldat ;Oata stored here every 0C1 int 


3083 


FFSE 


C6 10 


idab #16 ;ienoth of string 


3084 


FF90 


BD F£ 88 


jar PHMSG .-print in hex (dump! 


3085 








3086 


FF93 


BS 10 03 


Waa PORTC rcurrant digital value* 


3087 


FF96 


80 3A 


bar outb ;jar HOUTS ;otit + spc (dump) 


3088 








3089 






jusing RTC lor delay 


3090 


FF98 


C6 04 


idab #SDRATE ;got rata value 


3091 


FF9A 


CE 10 00 


idx #REG ;gei thabaaa 


3092 


FF9D 


ID 2S BF 


?wmo: bclr TR0>2,x,$8F ,-R/M/W knock down RTIF (440) 


3093 


FFAO 




?ckip: 


3094 


FFAO 


8D FF 21 


jsHNDQ ;any key*? (dump) 


3095 








3098 


FFA3 


24 09 


bcc ?srt ;yw, do am 


3097 








3098 


FFA5 


1 F 25 40 F7 


brcir TFLG2.x.$40,?cklp ;hang around until RT1F 


3099 








3100 


FFA9 


SA 


deob ;coum out time 


3101 


FFAA 


2E F1 


bgt ?wtrto ;hang around soma mora 


3102 








3103 


FFAC 


20 D2 


bra DUMP :anoth«r tima around 


3104 




~ '" ""' ' 




~nwr 






;?srt: t«r RTOSPW ;chack for eacapa or tuna 


3106 


FFAE 


81 IB 


7srt: cmpo #ESC ;escape 


3107 


FFBO 


26 CE 


bna DUMP 


3108 








3109 


FFB2 


39 


dand; rta 


3110 








3111 








3112 






; FLAGS) toggle* varioua flag bita 


3113 


FFB3 


8D 88 


FLAGS: bar HEXJB1G ;gat bit # 


3114 


FFB5 


2SFB 


bc» dand ;no value, skip out 


3115 








3116 


FFB7 


CE 00 40 


Idx #Hag1 ,-start hare 


3117 






; tdab Ubb ,-get value 


3118 






cmpb #16 ;upper limit 


3119 






:: bhi dand ;too big ItWt covert negative too since unsigned) 


3120 






bmi dand ^negative, ao skip 


3121 








3122 






cmpb #8 .-threshold for Rag2 


3123 






; Wt?flg1 ,iiMui> 


3124 








3125 






; inx ;point to R«g2 


3126 






; cmpb #16 ;thrashold f of Rag3 


3127 






; bit?fffl1 ;ok 


3128 








3129 






; inx .point to Fiag3 


3130 






;?flg1: 


3131 






;ia"v« 12v 


3132 


FFSA 


96 45 


Ida* Lsbb ;get value 


3133 


FFBC 


16 


tab ;copy 


3134 


FFBD 


56 


/orb ;get highoat 5 bits in position 


313S 


FFBE 


56 


rorb 



70 
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3136 
3137 
3138 
3139 
3140 
3141 
3142 
3143 
3144 
3145 
3146 
3147 
3148 
. 3149 
3150 
3131 
3152 
31S3 
3154 
31 55 
3156 
3157 
3158 
3159 
3160 
3161 

3163 
3164 
316S 
3166 
3167 
3168 
3169 
31 70 
3171 
3172 
3173 
3174 
317S 
3178 
3177 
3178 
3179 



FFBF 56 
FFCO CI 04 
FFC2 22 EE 



FFC5 16 

FFC6 C4 07 

FFC8 4F 

FFC9 OD 

FFCA 49 

FFCB 5A 

FFCC 2C FC 

FFCE A3 00 

FFOO A7 00 

FFD2 7EFEAF 



;index into Flags table 
;copy again 



?slp; rola rahift across 

docb ;eount it 

bge ?alp ;unol -1 (base 0) 

aoro 0,x ;ftip tha bits into 9 
staa 0,x .and put back 
outb: jmp HOUTS ;echo result & return {Ipromptl 



inc SPOR 
idy *100 



*LlO_;i«(Bju..bit_ 



Idx Flsgl 


;gatem both (DATAI 


jv H0UTC2 


;dumpem 


Idx tSPCn 


;SPi 


ldab#3 


rlangth. prints all three SF1 


jmp PHMSG 


;measag.e 


Idaa Anldat 


;get chO vafue 


jmp LD_MOTOfl 


;ua« it h«r« 


jsr HEX BtQ 
idsaMsbb 


;get a value 


bsr HOUTS 


;uppar 


IdM Lsbb 

jmp HOUT 


;print it and return 



3130 ; 

3181 ; HELP! print out screen of h 



3182 

3183 .-HELP: idx #HLPMSG )G«t pointer 

3184 : jmpPMSG ;Print help string &. return 
3185 

3186 jHLPMSG: db CR,LF 

3187 ; db"7 Adj Dmp Entr \Wmp Tun Sov A Rst *Tat".CR,LF-t- $80 

3188 -page 
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3189 
3190 
3191 
3192 
3193 
3194 
3195 
3196 



.-Interrupt Vector* 

ABSOLUTE 
; orfl 9FFD2 

;RSTT: imp START 



labsoiuto positions 

{reserved but we'll use the space 

;unknow ints trap to hare and cousi 



3197 


FFD6 


FDCB 


dw SCIINT 


;FF06 SCI int 


3198 


FFDfl 


FBCS 


dw START 


;FFD8 SPI int 


3199 


FFDA 


FBCS 


dw START 


;FFDA PA1 


3200 


FFOC 


FBCS 


dw START 


;FF0C PAOV 


3201 


FFDE 


Facs 


dw START 


;rTD£ TOt 


3202 










3203 






org »FFE0 




3204 


FFE0 


FBC5 


dw START 


;FF£0 OCS int 


3205 


FFE2 


FBCS 


dw START 


;FFE2 0C4 


3208 


FFE4 


FBCS 


dw START 


;FFE4 OC3 


3207 


FFE6 


FBC5 


dw START 


;FFE6 0C2 


3208 


FFE8 


F947 


dw TiMINT 


:FFE8 0C1 


3209 


FFEA 


FBCS 


dw START 


;FFEA IC3 


321 0 


FFEC 


FBCS 


dw START 


;FfEC IC2 


3211 


FFEE 


FBCS 


dw START 


;FFK !C1 



321S 
3216 
3217 
3218 
3219 
3220 
3221 
3222 
3223 



-fFFO— FBCS— 

FFF2 FBCS 

FFF4 FE3S 

FFF8 FBD6 

FFF8 F8D6 

FFFA FBCS 

FFFC FBC5 

FFFE FBCS 

0000 



dw START ;FFF2 Interrupt ReQuest 
dw XRET ;FFF4 X1RQ quick RT1 

d w ISTART ;FFF« SoftWar* Int 

dw ISTART ;FFF8 Illegal INStruction 

dw START ;FFFA Computer Operating Properly watchdog 

dw START ;FFFC CLocK Monitor 

dw START ;FFFE power on RESET 



Linaa Aaaambled : 3223 Aeaembty Errora.: 0 

35 

Claims 

1. In an above knee prosthesis (AKP) having upper and lower leg segments and a connecting knee joint, 
ao . the improvement comprising: 

a linear, hydraulic damper for separately and variably damping each of flexion and extension 
rotational movements of the knee joint; 

electronic sensing means for measuring each of AKP knee angle and lower leg segment strain and 
emitting signals indicative thereof; 
45 actuating means for adjusting the damper to vary damping of the knee joint in flexion and 

extension; and 

programmed computer means for receiving the emitted signals from the sensing means and 
comparing them to stored threshold values which are indicative of pre-determined transition points 
selected for adjustment of at least one of flexion and extension damping, and, when the received signal 
50 values correlate with stored values, causing the actuating means to vary damping, 

2. A method for controlling the knee joint of an above knee prosthesis having a knee joint, lower leg and 
ankle, comprising: 

storing, in a computer memory, threshold values of lower leg strain and knee angle, which values 
55 are indicative of the knee joint bending in stance phase, of anterior positioning of the center of gravity 
of body weight relative to the ankle, and of swing phase, all in the course of a step along a level 
surface; 

continuously sensing lower leg strain and knee angle during use of the prosthesis and producing 



72 



EP 0 549 855 A2 



electronic signals corresponding thereto; 

comparing the signals against the stored threshold values and, when the signals substantially 
correlate with threshold values, automatically altering the rate of rotation of the knee joint in one or both 
of flexion and extension, as required. 

s 

3. A bi-directional variable linear hydraulic damper for use in an above knee prosthesis, comprising: 

a hollow closed cylinder comprising end walls and a side wall forming a chamber for retaining 
hydraulic fluid, each end wall forming a rod opening; 

a cylindrical hollow piston disposed in the cylinder chamber and adapted to slide longitudinally 
10 therein, said piston having axial rods extending through the rod openings in sealed engagement with 
the cylinder; 

said piston carrying an exterior circumferential seal ring between its ends, said sear ring being in 
sealing relationship with the cylinder side wall, said piston being formed by end wails and a side wall, 
said piston, forming a first aperture through its wall above the seal ring and a second aperture through 
75 its wall below the seal ring; 

a first one way check valve controlling the first aperture for enabling ingress of fluid into the piston 
chamber from the first end of the cylinder chamber 

a second one way check valve controlling the second aperture for enabling ingress of fluid into the 
piston chamber from the second end of the cylinder chamber; 
so a first pair of diametrically opposed ports extending through the piston side wall adjacent its first 

end, on one side of the seal ring; 

a sec ond pair of diametricall y opposed po rts extending through the piston side wall ad jacent its 

second end, on the other side of the seal ring; and. 

valve means for progressively reducing or increasing the effective area available for fluid flow of the 
25 first ports and separately progressively reducing or increasing the effective area available for fluid -flow 
of the second ports. 

4. In an above knee prosthesis (AKP) for use by a human user, said AKP having upper and lowers- leg 
segments, a knee joint connecting the segments, and a foot attached to the base of the lower leg 

so segment, the improvement comprising: 

means, pivotally connected with the leg segments, for separately and variably damping each of 
flexion and extension rotational movements of the knee joint; 

electronic sensing means for monitoring AKP knee angle and position of the center of gravity of the 
user's body relative to the AKP foot and emitting signals indicative thereof; 
35 actuating means for adjusting the damping means to vary damping of the knee joint; and 

programmed computer means for receiving the emitted signals from the sensing means and 
continuously establishing from said signals the state of the AKP in the course of a movement and 
activating the actuating means to vary damping to substantially simulate natural knee action. 

40 5. The improvement as set forth in claim 4 wherein the damping means comprises: - 

a pair of closed chambers for containing hydraulic fluid, 

means, connected to the leg segments and forming two passageways connecting the chambers, 
for moving fluid from one chamber to the other through one of the passageways when the leg 
segments are moving together and through the other of the passageways when the leg segments are 
45 moving apart, and 

means for regulating the flow of fluid through each passageway; 

said actuating means being adapted to adjust the regulating means to vary damping of the knee 
joint. 

so 6. The improvement as set forth in claim 4 wherein the damping means is a bi-directional variable linear 
hydraulic damper comprising: 

a hollow closed cylinder comprising end walls and a side wall forming a chamber for retaining 
hydraulic fluid; 

a cylindrical hollow piston disposed in the cylinder chamber and adapted to slide longitudinally 
55 therein; 

said piston carrying an exterior circumferential seal ring between its ends, said seal ring being in 
sealing relationship with the cylinder side wall, said piston being formed by end walls and a side wall, 
said piston forming a first aperture through its wall above the seal ring and a second aperture through 
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its wall below the seal ring, said piston dividing the cylinder chamber into closed first and second 
end chambers; 

a first one way check valve controlling the first aperture for enabling ingress of fluid into the piston 
chamber from the first end chamber; 
5 a second one way check valve controlling the second aperture for enabling ingress of fluid into the 

piston chamber from the second end chamber; 

a first pair of diametrically opposed ports extending through the piston side wail adjacent its first 
end, on one side of the seal ring; 

a second pair of diametrically opposed ports extending through the piston side wall adjacent its 
10 second end, on the other side of the seal ring: and 

valve means for progressively reducing or increasing the effective area available for fluid flow of the 
first ports and separately progressively reducing or increasing the effective area available for fluid flow 
of the second ports; 

said actuating means being adapted to adjust the valve means to vary damping of the knee joint. 

is 

7. The improvement as set forth in claim 4 wherein the programmed computer means is adapted to 
compare the emitted signals against stored threshold values indicative of transition points between 
states of a repetitive movement of the AKP and, when the signals substantially correlate with threshold 
values, to alter the rate of rotation of the knee joint in one of or both of flexion and extension. 

20 

8. The improvement as set forth in claim 7 wherein the stored threshold values are selected from the 
group consisting of the absolute and derivative va lues of kneejinglo arid the position of thejsenter,.oL 

gravity of the user's body relative to the AKP foot, the duration from the last transition point and the 
possible future states in the course of the movement. 

25 

9. The improvement as set forth in claim 8 wherein: 

the sensing means for monitoring the position of the center of gravity of the user's body relative to 
the AKP foot consists of means for monitoring lower leg strain. 

30 10. The improvement as set forth in claim 6 wherein the programmed computer means is adapted to 
compare the emitted signals against stored threshold values indicative of transition points between 
states of a repetitive movement of the AKP and, when the signals substantially correlate with threshold 
values, to alter the rate of rotation of the knee joint in one of or both of flexion and extension. 

35 11. The improvement as set forth in claim 10 wherein the stored threshold values are selected from the 
group consisting of the absolute and derivative values of knee angle and the position of the center of 
gravity of the user's body relative to the AKP foot, the duration from the last transition point and the 
possible future states in the course of the movement. 

4a 12. The improvement as set forth in claim 11 wherein: 

the sensing means for monitoring the position of the center of gravity of the user's body relative to 
the AKP foot consists of means for monitoring lower leg strain. 



so 
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Fig. 4a. 
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Fig, 6a, 



EP 0 549 855 A2 




EP 0 549 855 A2 




EP 0 549 855 A2 




EP 0 549 855 A2 




EP 0 549 855 A2 



FLEXION 



KNEE 
ANGLE 
(DEG) 




EXTENSION 
STATES I 



ANKLE 
SENDING 
MOMENT 

(N-m) 



HEEL 



TIME (sec) 
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FLEXION 
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TIME (sec) 

Fig. 11, 
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Fig. 28. 
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47 
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PEI 
PE2 
PE3 
PE4 
PES 
PE6 
PE7 



6SHCII 
PEO PCO 
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10 


3 




PCI 




II 


4 


j 
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12 
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13 
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14 


7 


f 
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pes 




16 
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* 
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33 
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4 


32 




PA3 




■ 
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9 
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Fig. 29. Ig9 
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Fig, 33. 

T.he core of the program is the Timer Interruot Service Routine. 
Every 20 miliseconas the timer interrupts and... 



Timer interrupt: (Timelnt @ 20 milisecond intervals) 
Get new A/D values into FIFO (first in. first out), discarding oldest values. 
Generate any required output to actuators. 
IF stop timer running, count down. On time-out, sat Malt flag, force 

battery cut-off rule to fire. 
IF Seep command active, exBcute time-outs as required, turn Beeper on/off. 
IF forced rule active, count down time. On time-out force rule, 
j goto £ND_OF_SCAN. 

| IF not halted or not scanning already, scan rule table for executable rules, 
j END_OF_SCAN: Return from timer interrupt 



Scan: (of rules) 



For each active rule in MODE bit field 
IF rule preconditions exist and are met 
AND If digital conditions exist and are met 
AND If analog conditions exist and are met 
THEN fire rule, exit loop, (only one rule fires per timer interrupt). 



FireRule: 

IF rule number not inhibited THEN generate required output 
(Digital, Analog. Pulse, Mode change, Subroutine, Beep etc) 
Output current rule number to SP! port to permit external 
D/A monitoring of state change*. 
If a Forced Time exists, update FRCTIM counter. 
If rule is not special case (#0), update current rule value in memory, 
(for rule precondition teste). 



A standard implementation of circular buffers is used for interrupt driven 
input and output via a serial communications port on the microprocessor. 
On each serial communications interrupt.. 



SERIAL INTERRUPT: 

IF Receiver Interrupt THEN 

WHILE we do not have space in the input circular buffer, WAIT. 
Enque the received character, update in_pointer & counter. 
ELSEIF 

Transmitter interrupt THEN 

IF we have a character to send, send it update outjjointer & counter. 
ELSE 

turn off transmitter interrupt since nothing left to sand. 
Return from SERIAL INTERRUPT 
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' Entry on power up I 



Fig. 34. 



INITIALIZATION: 

Initialize memory, data tables & registers to support interrupt 
driven input & output and timer interrupts. 
Make default set of rules active. 
Force rule #1 to fire, (start-up rule) 



MAIN: 

IF current state value changes, display changed value. 
Await communication line input 
IF a valid command character has been entered, 
execute chosen command. 
ELSE 

display error i 
-Qolo-MAJN — 



ADJUST: 

Prompt for rule # to adjust Accept input from communication line. 
Display chosen rule # elements. Prompt for alement # to adjust 
Make adjustments as commanded by communication line input 
Return to MAIN 



DUMP: 

Until terminated by communication line command input... 
DISPLAY: 

Display current Mode, State #, A/D values & Derivatives 
and Digital input value. 

Wait for preset time (nominally 10 lines per second}. . 
Goto DISPLAY * 



ENTER: 

Prompt for address to modify. Accept input from communication One. 
Display current value at specified address. 

Make changes to value as commanded by communication line input 
Return to MAIN whan changes completed. 



MEMORY: 

Prompt for address to display. Accept input from communication line. 
Display 258 values from that address forward. 
Return to MAIN 



Save: 

Save any changes made to last selected rule # to EEPROM. 
Return to MAIN 
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© System for controlling artificial knee joint action in an above knee prosthesis. 
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© This invention relates to an above knee prothesis 
which employs a hydraulic damper to passively reg- 
ulate the angular velocity or rotation of the artificial 
knee joint. A programmed microprocessor recog- 
nizes common gait patterns from information re- 
ceived from strain and knee angle sensors on the 
prosthesis. The microprocessor reacts at various 
transition points in the gait by activating a motor 
which in turn adjusts a valve assembly in the damp- 
er. The valve assembly is capable of variably and 
separately damping the knee joint motion in each of 
flexion and extension at the same time. Gait is 
improved because of the improved extent of control 
of knee action. In addition, distinct routines such as 
stair descending and sitting down can also be prac- 
tised. 
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